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DELTA PAC ATTITUDE DETERMINATION AND ERROR PREDICTION 


INTRODUCTION 

The Delta Packaged control spacecraft (Delta PAC) was an earth satellite de- 
signed, built, and tested in house by the Technology Directorate under the leader- 
ship of the System Division. The Delta PAC attitude determination and error 
prediction project was assigned to the author in Jan. 1969, and was completed in 
six months. It consists of both an analysis and a FORTRAN IV program. The 
computer program was utilized to evaluate the spacecraft attitude control system 
after it was launched into a circular orbit. 

The Delta PAC control system contains one gimballed fly-wheel scanner with 
electronic damping that actively controls one axis and passively controls the 
other two axes. The spacecraft is therefore stabilized about all three axes. The 
mission objectives of this spacecraft is to test the earth stabilized control sys- 
tem for future spacecraft applications. The evaluation of the behavior of this 
spacecraft and the flight performance of its control system depends upon a 
knowledge of the PAC attitude. Therefore, the problem of attitude determination 
is of great importance. 

This report presents the analysis of that project with the FORTRAN IV as its 
appendix. The analysis includes: 
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(1) Formulation of attitude determination equations: An approach is developed 
in which the complete sensor data are used to determine two independent 
vectors, such as the local vertical and the sun line. These vectors are 
then applied to obtain the attitude of the spacecraft. 

(2) Presentation of special cases: Various cases arising from incomplete 
sensor output have been considered. 

(3) Examination of error propagation: Since measurement errors could exist 
in the sensor data, each calculation is subjected to errors. The effect of 
the errors on the determination of orientation of Delta PAC caused by 
errors of the measurement quantities is also explored. 

Coordinate Axes Definitions 

For convenience, it is necessary to make the following definitions. 

(1) First Reference Axes. -The first coordinate system X g , Y s , Z s has center 
at the spacecraft's noon position where 
X s axis is along the spacecraft's velocity vector. 

Z s axis is along the negative sun line vector. 

Y axis is determined by 

S 



(2) Second Reference Axes. -The second coordinate system X Q , Y 0 , Z Q has the 
same center as the first coordinate system with 
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Y q = normal to the orbit plane 

Z o = the vector pointing downward toward the local vertical. 

(3) Orbital Reference Axes. -The third coordinate system X, Y, Z has its center 
at the instantaneous location of the spacecraft with 

X = spacecraft’s velocity vector 
Y = Y q 

Z = the downward local vertical 

(4) The Spacecraft Body Axes. -The spacecraft body coordinate system x, y, z 
is a set of right handed mutually orthogonal axes fixed m the spacecraft 
with their origin at the center of mass. It is required that the attitude con- 
trol system maintain the alignment of the spacecraft body axes with the 
orbital axes system. That is, the yaw axis (z) is pointed toward the down- 
ward vertical and the pitch axis (y) is aligned with the normal to the orbit 
plane, thus causing the roll axis (x) to align with the spacecraft’s velocity 
vector. Any attitude error is detected by a control subsystem which con- 
sists of an earth sensor and three sun sensors. 

(5) The Sun Sensor Axes System. -There are three sun sensors mounted at 120 
degree intervals on the top surface of the Delta PAC. Each sun sensor 
head i has its own right handed system e i , f , g i which is oriented such 
that 

(a) The axis is in the x-y plane 

(b) The angle between g^ and y is 90° + g 
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(c) The angle between and x is 180°+ ^ 

(d) The angle between e A and z Is 90 + v i 
The nominal constant ^ and are: 

" °> i 2 = 120 ° ^3 = 240 ° 

^ = ^2 = ^3 = 2& ° 



Figure ] Sun Sensor Zenith Axes e^, e 2 , 

The Reference Axes Transformation Equations 
If 

a = the angle between Z Q and Z 

/3 = the angle between orbit plane and the earth-sun line with positive 
sign when the sun is above the X Q - Z Q plane (see Figure 2), the relationship 
between the first three reference axes can be expressed as 
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Xo=Xs 


Figure 2. The orbital Reference Axes 
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(Tl) 


The range of fi is -55° < fi <55° for Delta PAC calculated from orbit 
determination. 
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Let S be the sun line vector, the components of Sin each of three reference 
coordinate systems can therefore be determined. It is obvious that 

S = 0-X s+ 0-Y s -Z 

inthe X s , Y s , Z s system, and 

S = sin fi Y Q - cos /3 Z Q 

inthe Xq, Y 0 , Z 0 system. 


Since the unit sun line vector has the coordinate (0,0, -1) inthe X g , Y Z g sys- 
tem, by using equation (Tl) the components of sun line in the X, Y, Z, system 
are: 


Therefore 
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- cos a cos /3 
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sin a cos fi • X + sin /3- Y - cos a cos/3-Z 


(T2) 


(T3) 


and 

S • Z = - cos a cos j3 - S 3 (T4) 

If there is no attitude error, the body axes x, y, z should be coincident with the 
orbital axes X, Y, Z respectively and equation (T2) are the "direction cosines of 
sun line in both axes systems. However, this is no longer true if a 


6 



misorientation takes place. For that case, the components of sun line in the 
body axes need to be determined and the sun sensors are used for this purpose. 

The Sun Sensor Equations 

Let S x , S y , S z be the components of the sun line vector S in the body axes sys- 
tem. Then 

S = S x x + S y y +■ S z z (SI) 

The method of determining the values of S x , S y , and S z is described as follows. 

The body axes x, y, z can be aligned with the sun sensor axes e i , f , g. by the 
sequence of three rotations: a first rotation R a (90° + £ ) about axis z through 
an angle 90° + a second rotation R y ( 7 ^) about displaced y axis through an 
angle and a third rotation R x (-90°) about displaced x axis through an angle 
-90° (See Figure 3), The transformation may be written in the following matrix 
form. 
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Figure 3 Sensor Frame System e^, f-j g-j 
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The sensor telemetry yields i (i = 1, 2, or 3) which indicates that the i th sensor 
receives the greatest sun intensity and is selected to produce the output. The 
output of the selected sensor is two angles and /3 which define two planes, 
each containing the sun (Figure 4). The intersection of these two planes de- 
termines the sun-lme. 


Let S u , S 2l and S 3i be the direction cosines of sun-line OS with respect to the 
1 th sun sensor system (see Figure 4). Then: 


S = S e + S„. f + S g 

li 1 2i 1 r 3i 


(S7) 
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Using equation (S7) and equation (S3) or equation (S6) and equation (S7), the 
components of the sun vector S in the body axes system can be found. That is 
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In terms of known quantities, equation (SIO) becomes 
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(Sll) 

This final form and equation (T2) are used to obtain the attitude determination 
equations. 


The Earth Sensor Equations 

Since the local vertical Z in the orbital axes system has components 



the same vector Z m the body axes system can be written as 
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Here the components 


[Z] b = 


‘13 


23 


33 


(E3) 


are to be determined by the measured quantities obtained from the earth sensor. 


For Delta PAC there is one earth sensor, which is a horizon scanner. The 
scanner is mounted on a gimbaled platform which rotates about the spacecraft 
roll axes (x). Eddy currents induced by the motion of the gimbal with respect to 
the spacecraft provide the means for damping the spacecraft roll-yaw motion. 
The sc ann er cone axis (Y w ) coincides with body pitch axis (y) when the gimbal 
angle y is zero (see Figure 5). The range of y is: -30° - y - 30°. 


In general, the scan pattern of a single scanner is a cone. As the scan cone cuts 
the earth, a voltage earth pulse of width 2 p is emitted by a sensing element called 
a bolometer. The width of this pulse represents the angular portion of the cone 
which interesects the earth (see Figure 6). 

Let an intermediate parameter C 23 be calculated first, where 

C 23 = the scalar product of two unit vectors which represent the scan cone 

* — ^ ■ — > 

axis Y w and the local vertical 7 . 

The equation expressing the relationship between the variable C 23 and the earth 
pulse half width p are presented as follows: 
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EDDY CURRENT DAMPER 



Figure 5 The Horizon Scanner 
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Figure 6. The Scanner Geometry 


where 


R = the earth’s radius 

e 

h = the orbital altitude 


The earth pulse half width p is in the range (0, 180). If the scanner does not 
see the earth, p is then zero and the variable C 00 is less than cos (a + ex). If 
the scan cone is completely on the earth, p is 180° and C 23 is larger than cos 
(a e - a). The variable C 23 is computed from equation (£4) only when p lies 
between 0° and 180°. In this case, the result of derivation gives: 

cos a cos cr ± cos p sin cr / sin 2 a - sin 2 cr sin 2 p 
C = 1 5 (E5) 

f 2 2 

1 - sirr cr sin p 
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Based on the fact that C 23 and cos p vary inversely, it can be shown that the 
positive sign in the numerator should be discarded, i.e., 


r* c in- rr 


cos a cos cr - cos p s in cr vsmr a - sin cr sin p 

O — e 6 

U 23 


1 - sin 2 cr sin 2 


(E6) 


for 0 < p < 180 


The unit vector representing the scan cone axis can be written as 

Y w - cos y y + sin y z 
where y is the gimbal angle. Therefore 

C 23 = 2 ' % = a 23 COS y + a 33 sin y ( E7 ) 

or 

a 33 sin y - C 23 - a 23 cos y (E8) 

Suppose that a unit vector Z w is defined such that in conjunction with X^ v = x 
(spacecraft roll axis) and the scanner cone axis Y w , a right handed orthogonal 

coordinate system is formed. Then 

■ — ► . ^ t 

Z - x x Y = — sin y y + cos y z 

w w ' J r 

giving 

Z • \ = a 33 cos y - a 23 sin 7 
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% 
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Define the pitch computed angle <9 s measured about the scanner axis Y w as 
follows 
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This implies 
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Solving equation (E7) and equation (E10), gives: 


a 23 = ^23 cos y ± AT C* 3 sin 7 cos # s J 

> (EH) 

a 33 = C 23 Sin y + 1/1 - C 23 COS ? COS 0 s J 

In addition to providing a measure of the angle p , the earth pulse is used to ob- 
tain 8 s through the use of signal processing which is described in the following 
paragraph: 

When the scanner passes a reference mark in the yaw-pitch plane of the space- 
craft, a reference pulse is generated by a magnetic wedge attached to the pitch 
wheel. By comparing the reference pulse with the center of the earth pulse, a 
measure of the angle is obtained. For 180° of rotation after the reference 
pulse, the signal processor causes any portion of the earth pulse to contribute 
to e in a positive sense. For the remaining 180°, of rotation, the earth pulse 
contributes in a negative sense. If the earth pulse contains the reference mark 
but not the 180 mark, then it does indeed measure & s . If these conditions are 
not met, the exact relation is summarized mathematically by the following 
equation: 

e = (sign & s ) Min {l#,!, 1 180° - 6 s \ , p, 180° - /?, E} (E12) 

where 

E - 45 is the electronic saturation angle 
e - telementered scanner pitch signal. 
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The plot of e vs. @ s is shown in Figure 7. 



For convenience, a new variable, e s , is defined and equal to: 

e g = Mm (p, 180°- p, E) (E13) 

Accordingly, the case: 

I e I ^ e s 

and 


are to be discussed. 


(1) When the absolute value of e is less than e s , there are possibilities that: 

6 — e 

5 

or 

e s = ± (180° - |e|) (El 4) 
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Care must be taken to consider all these possible cases. Four sets of equations 
are thus obtained to represent [Z] b . They are 

i — — i 


3 I3 
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In order to determine which of these four sets is the correct local vertical, 
note that 

[S ♦ Z] 0 = - cos a cos /3 

Since the scalar product of two vectors has the same value regardless of what 
coordinate axis system is used, therefore 

[S • Z] b = S x a 13 + S y a 23 + S z a 33 = - cos a cos /3 (£16) 
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The representation in equation (E15) which best satisfies this criterion is the 
proper expression. 


(2) When the absolute value of e is equal to e s , e is saturated. The telemetered 
error signal e fails to have a definite value and equation (E14) is no longer use- 
ful in determining & s . However it is still possible to find Cz ] b by makin'g‘-use 

of p and [ S ] b . The parameter C 23 determined from, p in equation (E6) is the 

— » * > 

cosine of the angle between the sensor cone axis Y w and the local vertical Z. 

Thus the local vertical must be on a cone with axis Y w . The cosine of the angle 

between Z and S is -cos a cos {3 and thus Z must lie on a cone with axis S . The 

determination of the intersection of these two cones is accomplished by solving 

equation (E16) with equation (E7) to obtain a 23 and a 33 in terms of a 13 . This 

gives 
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(El 7) 


S sin 7-S cos 7 / 0 
y ' z * 


If both equations in (E17.) are squared and are substituted in the following: 
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a quadratic equation of a 13 is obtained. That is, 

Ea i3 + F a i3 = 0 < E19 > 

where 

E = S 2 + (S y sin y - S z cos y) 2 
F = 2 S x (cos a cos /3 + C 23 (S z sin y +-S cos y)) 

and 

G = - (S sin y - S cos y) 2 + 2 C„, cos a cos /3 (S sin y + S cos y) 
y z z y 

+ cos 2 a cos 2 P> + c 2 3 (S 2 + S 2 ) 

Solutions of the resulting equation for a are then substituted in equation (El 7) 
to obtain a 2 3 and a 33 . 
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Consequently the following equations apply 


ai 


1'3 


- cos a cos /3 cos y - S y C 23 
S cosy 


a 23 = C 23 cos 7 ± t-any ^ (1 -C 2 3 ) S 2 cos 2 y- (cos acos /3cos y + S y c”) 2 /^ 


(E2-1) 


> 


*3 3 
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J 


which apply except where S x = 0 that is when the sun lies on the sensor cone 

i 

axis. Note that 'if 6 s can not be determined, then in general two solutions are 
obtained, from which. selection of the correct solution can not be made without 
additional information. 


The Attitude Determination Equations 

i 

At this point the direction cosines of the local vertical and the sun line with 
respect to the body axes system are known. They can be utilized to determine 
the spacecraft’s attitude. 

Suppose that the transformation matrix taking the orbital axes system into the 
body axes system is: 

x = A u X + A i2 Y + A l3 Z 

y = -A 21 X + A 22 Y + A 23 Z (Al) 

z = A 3i X + A 32 Y + A 33 Z 
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The coefficient A XJ (i, j =1, 2, 3) in equation (Al) defines a matrix 
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AAA 
“21 “22 “23 


AAA 
“31 “32 “33 


(A2) 


Equation (Al) implies that any vector V in the X, Y, Z system* written in column 
form, may be transformed into x, y, z system by the application of the matrix 
[A ] . That is 


where 
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(A3) 


are the components of V in the body axes system and in the orbital axes system 
respectively. 


In order to determine the direction cosine matrix [A] it is assumed that [S] 0 
and [Z] 0 are known and that ls3 b and [zl b have been determined. By defining 

F = Z x S (A4) 
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the column, matrix Lf] 0 and [FJ b can be obtained 



(A5) 



F 


S 0 " S 3 ^ 0 


X 


• z 23 y 33 

11 

1 — 1 
1 i 

F 

y 

= 

„ a 33 “ a l3 


F 

Z 


% a i3 " S x a 23 


(A6) 


If equation (A3) is applied to the vectors Z , S and F respectively, it produces 
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(AS) 


(A9) 


Combining these three column matrix equations into a single square matrix 
equation, yields 
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(A10) 
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It may be written in this simple notation 
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The determinant of [Q] is 


(All) 


(A12) 


(A13) 


det [Q] = |Q| = +S2 

= 1-Sf 


(A14) 


If S 3 £ ±1, then 


IqI 


The matrix [Q] is non-singular and possesses an inverse [Q] -1 where 
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- S 1 S 3 - S 2 S 3' !- S ! 


S Ql -i.= -i- 

* ~ l 1-Si 


By multiplying the matrix equation (A12) with EQ] 1 , gives 


[B] [Q ]” 1 = [A] [Q] [Q ]" 1 


[A] = [B] [Q]- 


Therefore 
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(A24) 


A 31 = — < S 1 CS 2 - *33 


A 32 “ (S. - a 33 
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Euler Angle Transformations 

Any attitude errors of the body axes relative to the desired orientation (that is, 
any deviation of the x, y, z, axes from the X, Y, Z axes) can be represented by 
Euler angle rotations: yaw angle i p around the Z axis, roll angle <j> about the 
displaced X axis , and pitch angle 9 about the doubly displaced Y axis (see Figure 
8), The notation to be used for the matrix which performs each of these three 
Euler rotations is 
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<• 

Given any vector V with components V , V 2 , V , in the Orbital ;axes system, 'its 
components v x , v y , v z in the body axes system are 

f ( 
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sin 9 sin i p - cos 6 sin <^>cos 


- s-in 9 cos <f> 
sin<£ 

•cos 9 cos <f> 



Comparing this equation with matrix equation (A3) gives 


[A] 


cos 5cos^-sin0sin0sim/i 
cos sin i p 

sin 9 cos \jj~ cos 6 sin^sini/i 


cos 8 sini/rfsin^sin^cosi/i 
COS0COSI p i 

sin(9sini/f-cos0sin<£cos0 


- sin 9 cos 4> '■ 
sin<£ 

cos 9 cos <fi 


The roll angle 4>, pitch angle 8, and yaw angle 0 can thus be derived: 


a i3 = ~ s ^ n ^ cos $ 

a 23 = Sin< £ 
a 33 = cos 6 cos 4> 
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and 




Figure 8- Attitude Error Representation Roll Pitch 6 , Yaw 0 
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Presentation of Special Cases 

Several cases are, presented in this report to illustrate the conditions in which - 
the earth sensor or the sun sensor or both fails to provide the sufficient informa- 
tion. If any of these cases does occur, it is convenient to use a graphical repre-^ T 
sentation of the curves.’related a 13 , a 23 and a 33 on a unity sphere which is de- w 
fined as a sphere m a 13 , a 23 , a 33 space of unit radius and fixed to the 'spacecraft 
axis system with center at the origin. Since 



the local vertical certainly lies on the surface of this sphere .at any moment and 
provides a convenient means for visualizing the motion of the local vertical with 
respect to body axes. It is useful to indicate the geometric region for displaying 
the local vertical on such a unity sphere and project it on the a 13 , a 23 plane for 
positive and negative a 33 . 


(A) Case 1 

First, a worst case is considered if the spacecraft is in the earth’s shadow and 
if the earth sensor doesn’t cut the earth. Evidently, the local vertical and the 
sun-line cannot be determined. Since the earth sensor does not see the earth, it 
can be concluded that the local vertical must lie within one of two possible 
regions in which body axes vary as the gimbal angle y changes. If the equation (E8) 
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and the equation (Dl) are combined to eliminate , after some algebraic re- 
arrangement, the result gives: 


for 


a 23 - °23 COS 


■/l c | 3 


sxn y 



7/0 


(D2) 


Equation (D2) represents an ellipse within the aj 3 versus a 23 plane unity 
circles with center at E(C 23 cos y , 0), with major axis 1/2 ^1 - C* 3 and 
minor axis 1/2 sin y . There are two possible sets of curves: 

(A a ) When the scan cone does not cut earth, p ~ 0 and < cos (a e + a-) 
then 


a 23 - c 23 cos y 
^sin (a + ct) sin y 



*13 


sin (a e + ct) 


< 1 


(D3) 


(A b ) When the entire scan cone intersects the earth, i.e., p - 180 and 
<? 23 > cos (a e - ct), then: 


a 23 ~ C 23 cos 7 


isin ( a - ct) sin ■) >in (a - ct) 



13 


> 1 


(D4) 


The shaded areas in Figure 9 and 10 represent respectively the required pro- 
jections of region on the a 23 - a 13 plane indicated by equation (D3) and equation 
(04). 
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Figure 10. Projection of Error Region in a 23 -a 23 
plane when p= 180, 7 ? 0 
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Figure 12. Error Region in a 23 -a 13 piane when p- 180, y f=0 
The above two cases are illustrated in Figure 11 and Figure 12, respectively. 

(B) Case 2. 

Second, consider the case when the sun sensors do receive the sunlight, but the 
half earth pulse provided by the earth sensor shows its value of 0 or 180 de- 
grees. In addition to the knowledge that the local vertical lies within specified 
regions as noted previously, it is also known that it must lie somewhere on a 
specified curve. From the information given by the sun sensor, equation (Dl) and 
equation (E16) are useful for specifying this curve. Rewrite equation (E16) 
gives; 
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^2 a 33 “ ^3 “ S 13 a 23 


(D7) 


If S z =0, equation (D7) represents a straight line in a 23 -a 13 plane. 


If S z £ 0, combining equation (Dl) and equation (D7) to remove the a term, 


yields: 


< S x + + 2 S, S y a 13 a 23 + (S* + SJl a|, - 2 S 3 (S, a 13 + S y a 13 ) = S* - S’ 


(D8) 

2 
3 


This is the general form of an ellipse with the center at C (S S , S S ). If the 

3 y 3 x 

origin is translated to the center of ellipse, the two first degree terms of equa- 
tion (D8) can be removed. Then rotate the axes through an angle k ( k <, 90) where 


2 S x S v 

tan 2 k — 

s 2 - s 2 

y x 


Equation (D8) is thus transformed into a standard equation of an ellipse having 
the foci on the new a 13 axis with semi-axes ^ 1 - S|, and SJ1 - S2 . 


When either S y or S„ is zero, it is obvious that no rotation of the axes is 

' y 

necessary. 


When both S x and S y are zero, Equation (D8) represents a circle of radius 
y^l - S 2 , a point, if = ±1. 

Within the a 13 - a i3 plane, the projection of the curves defined by equation (D7) 
and (Dl) to represent the direction cosines of the body axes with respect to the 
local vertical also must satisfy the condition mentioned in section (A) Case 1. 
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Hence the portion of the, projection presented graphically on the - a^ plane 
within the region described in the previous section (A) according to p = 0 or 
p - 180 is all that can be obtained to meet the required conditions. 


It is helpful to generate another view of the sphere and plot the locus of the 
orbital Y axis (A 12 , A 22 , A 32 ). Obviously, it is a curve which lies on the ''sur- 
face of the A l2 (i = 1, 2, 3) direction unity sphere since 

a;; ♦ A 22 + A’ 2 = 1 (D: 

The projection of this curve on the A 32 - A 12 plane is given for both A 22 > 0 
and A 22 < 0. 


Using equation (T3) to form the scalar product S* Y , yields: 

S • Y = sin /3 (DIO) 

For convenience, the above equation is therefore written as: 

S * A 12 + S S A 22 + S, A,,, = P < D11 > 

If S y =0, then equation -(Dll) defines a straight line on the A 32 - A^ plane 

assuming S ^ 0 and solving the equation (Dll) for A , gives: 
y 22 


22 


sin a . S x A 12 - S, A 


32 


(D12) 


From equation (D9) and equation (D12) we have 

CSy + S’) A’ 2 + 2 S„ S, A 32 A i2 + (S’ + S’) A’ 2 - 2 S, sin f> A 32 
- 2 S x sin /? A 12 = Sy - sin 2 /3 


(D13) 
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It can be seen easily that the above equation represents a circle of S y = 1. How- 
ever, if S y is neither equal to 0 nor equal to 1, (D13) is the general equation of 
an ellipse of which the axes of symmetry are: 

a 32 = S 2 sin £ 
a l2 = S x sin/3 

and the center of symmetry is (S z sin fj, sin 0), like equation (D8) by a 
proper translation of the axes to remove the a term and the term and 
then by a rotation of the axes with a chosen angle A.' for the removal of the a 32 
a 12 term where 


S 2 _s 2 

z X 

The equation (D13) is reduced to a standard form with the foci on the new a 

A M 

axis and with semi axes cos/3 and S y cos /3 . 

From the above discussion, it is believed that the graphical techniques are use- 
ful to solve the algebraic system of relationships. This approach certainly 
limits the region from which the error of the attitudes of Delta PAC can be 
pictured. Such graphical representation can be plotted easily if a computer is 
used. A FORTRAN program subroutine plot is written for this purpose (see 
Appendix). 
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(C) Case 3 

Third, for the case when-the earth sensor does intersect the earth but the space- 
craft enters into ’the earth's shadow, the informations from the earth sensor 
will indicate one of the following possibilities 

(A) 0 < p < 180° and e is not saturated 

This case appears as if there were no sun sensors aboard in the spacecraft at 
that moment. The given informations can only indicate the possible locations 
of the local vertical which are represented by four sets of equations as shown 
in equations (E15). No selection can be made from these four sets of equations 
to represent the true local vertical because the information about the sun line 
is lacking. However if the locations of the local vertical determined at previous 
sequences of time during the same orbit are examined, it is always possible to 
make the proper selection. 

(B) 0 < p < 180° and e is saturated 

This one is similar to case 1 discussed previously. As before the information 
given by the earth sensor can only be used to obtain equation (D2) for y 0 and 
equation (D5) for y - 0. The only difference is that the variable C 23 . in this case 
has a definite value instead of having limited range. Therefore if the curve which 
relates a 13 , a 23 and a 33 on the surface of the unit sphere is projected on the 
a 23 ~ a i 3 Pl ane s the projection expresses exactly the relationship between a 
and a l3 . Clearly the projection is either an ellipse represented by equation (D2) 
for 7 / 0 or a straight line given by equation (D5) for y = 0. 
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Error Propagation 


It is a known fact that measurements are always accompanied by errors. How- 
ever small errors are more frequent than large ones since the goal of the sensor 
design is to keep errors as small as possible. Therefore it is reasonable to as- 
sume that the measured quantities which indirectly determine the PAC attitude 
contain errors but small ones. Because of these errors, the predicted attitudes 
might not be the true values but the difference between them is expected to be 
small also. 

For Delta PAC there are five quantities being measured by using the sun sensors 
and the earth sensor, namely: the angles a , and which determine the direction 
cosines of the sun lire with respect to the i th sensor system, the gimbal angle 
y , the half earth pulse p , and the telemetered pitch error e. The corresponding 
errors are defined by the symbols Aa^ A/3^ ,l\y, A p and Ae which are assumed 
to have the standard deviation , o-^ , oy , cr p and cr. respectively. All 
measurement errors due to unknown cause are of random type, and are inde- 
pendent to each other. They are assumed to follow the laws of probability as 
given by the normal distribution. 

It should be noted that the two angles a and fi defined in the sun sensor section 
are not measured quantities. At any time their values will be determined by 
orbit calculation and are assumed to contain no errors . 
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In this report the methods of probability are applied to analyze the :effeet of 

measurement errors. . It would be of interest to present the results in terms of . 

error ellipses for a given attitude, the error ellipses are ellipses of equal 

probability which are similarly placed and are centered at the predicted position 
» 

(h, k). They are determined by the formula 


1 

2(1- r 2 ) 






const 


(El) 


for 0 < r <1 where <r , o- and r are respectively standard deviation of two var- 
iables u and w and their correlation coefficients. If u and w are not correlated 
variables then the value of r is equal to 0 and equation (Rl) becomes 



(R2) 


For each ellipse there is a definite probability that a true position (u, w) will lie 
within the ellipse. The probability for (u, w) to belong to the ellipse L given by 
either equation (Rl) or (R2) is 


P = 1 - e“ L (-R3) 

and with L = 1/2, 4/2, and 9/2 the probabilities are 0.4, 0.8, and 0.99 respec- 
tively. Of course, formula (R3) can be inverted to find the value of L correspond- 
ing' to a given value of P. 
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It is essential that the determination of error ellipses for two variables u and 
w depend upon their predicted values of h and k and their standard deviations of 
cr and cr if r = 0. Therefore in considering the error ellipses of a„, and a 
and also of a 32 and a 19 for delta PAC, the former can be defined either at 0 <p< 

180° and |e ] <e g without sun sensor information, or at 0 < p <180 and j e j = e^ 
in conjunction with the sun’s direction; the later can only be presented when the 
local vertical and the sun line are known but not parallel. The calculation of 
prediction errors for PAC attitude is thus limited to the case when 0 < p < 180. 

If the attitude control system of Delta PAC works well, the values of variables 
a 23 and a 13 are expected to be much less than 1. That is, the projection of the 
true local vertical in a - a plane should stay well within a -a unity circle. 

2313 U 

For this reason, the correlation coefficient of a 23 and a 13 can be assumed to 
have the value of 0, and equation (R2) is used to obtain error ellipse for a 23 and 

^3 * 

Similarly, equation (R2) can be applied to obtain the. error ellipse for a 32 and 
a 12 . For Delta PAC each of these ellipses are centered at the prediction point 
with the probability of 0.99 that a true point falls within it. The lengths of the 
semi-axes are equal to 3( cr a J, i = 2, 1 for the a„ - ellipse and 3(cr a ), 

(j = 3, 1) for the a 32 - - a 12 ellipse where o-a 13 , <ra 23 , o-a 32 , and era 12 are the 
standard deviations of a 13 , a 23 , a 32 and a l2 , respectively. 

If equations (S9) are differentiated with respect to a i and /3 i the following equa- 


tions are obtained: 
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— — - = - s? s, sec 2 a 
c) a 11 31 


L = - s L s 2i sec2 ^ 


2i 2 

- s. s„ s, ser a 

3 a li 2i 3i i 

1 


(1 - s 2 ,) S u sec 2 p x 
^T= (1 - s^) s u sec 2 a 


= “- s n s 2i s 3, sec2 ^i 


By differentiating equations (S10) with respect to s n , s 2l and s 3i respectively, 


= - cos r] sin £ 

'l a l 


= sin ?7 sin £ 

'l ° 1 


= - COS £ 
=“1 


COS 7} COS ^ 
'l 


= - sin tj l cos 


y • 

— = -sin£ 


o s u 


sin 7) t 


= - cos 77 
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Since S , S and S are functions of variables s , s and s where each 
x y z n * 21 31 

variable is a function of the independent variables a. and therefore: 

BS 3s„ BS 3S, 

+ 


b s_ 


9S . 3s„ t 3S„ 3 s 2) as, as 3> 
da ds da ds r da ' Bs, 3 a 

1 ii i 2i i 3i i 

= - {S x s 3i + cos s u sec 2 a i 

dS x 3S X Bs u BS X Bs 2i d S x d s 3i 
9 A = 9S U 9 4 9 4 +9s 3i 

= - {S x S 21 - sin 7f i sin gj s u sec 2 fi j _ 

A similar method is applied to calculate the derivatives of 


> 


J 


(R6) 


9 s y as y as, as 

and 


B a B B ’ B a 

i 'i i 


BA 


with the aid of equations (R4) and equations of (R5) the results are: 


BS 

y 

B a 

1 

d s 

2 a 

i 

BS Z 

3 A 


= - {S y s 3i + sin <f z > s u sec 2 


= - {S s 2i + sm r) x cos f z > s lz sec 2 /? z 


= - S 


s, . s„ sec' a 
& li 3i i 


- {S z s 2i + cos TjJ s lz ' sec 2 /? 4 


(R7) 

(R8) 

(R9) 

(RIO) 


Consider the equation (E6) where C 23 is a function of p only. The error of C 23 

can be expressed in terms of measurement error of half earth pulse as 

dC„ 


AC.. = 


"23 


23 d 


Ap 


(Rll) 
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The standard deviation of C 23 is given by 


cr C = 
23 


d C, 


23 


d p 


cr p 


where cr p is the standard deviation of p and 


(R12) 


d C 23 (1 - Cj 3 ) sin cr sxn 

C 23 sinucos p - cos cr-Jl - C | 3 

For Delta PAC, cr = 45°, thus, it can be shown that C 23 cos p is less than 
-jl - C^ 3 whenever 0 < p <180. The differentiation of equation (E6) with 
respect to p in order to obtain equation (R12) is always possible. 


(R13) 


As mentioned before, there are two different cases which satisfy the condition 
0 < p <180, but require separate approaches. They are: 


(A) 


0 < p < 180 and e < 


In this case, the local vertical is determined by the earth sensor equation and is 
not affected by the measurement errors from the sun sensors. Therefore, 





(R14) 
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Evidently, the components of the local vertical depend only on the values of 7 , 

P , and e as shown in equation (E15). The standard deviation of a 13 , a 23 , and a 33 
can be expressed in terms of a , a and a as follows 

y 7 p e 



As noted at the end of the earth sensor equation section, there are four sets of 
equations, (see equation E13), representing the position of the local vertical. Only 
one set of these equations give the correct components of the local vertical and 
it is selected. The technique applied for the selection was mentioned before. 

The partial derivatives 


3 a i3 

dy 1 d p 


, and 


■» (7 — 1, 2, 3) 


which appear in this case should be calculated from the equations of that selected 
set. 


Since the components of the sun line are independent from the errors of the 
earth sensor, this implies 
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3 S 

X 


dy 

3p = 

3 e 

3 S 

3 S 

3 S 

y_ 

y 

y . 

3r 

3/0“ 

3 e 

3 S 

3 S 

3 S 

z _ 

z 

z 

3 y 

dp 

3 e 


Moreover, since S 1} S 2 , and S 3 depend only on the value of a and fS whiBift are 
assumed to contain no errors. It is obvious 

3 S i _ 3 S 2 _ 3 S s _ 

3a 3a 3a 

111 

3 Sj 3 S 2 3 S 3 

3 Sj 3 S 3 S, 

z — - = = 0 y (R17) 

o y a y dy 

3 Sj _ 3 S 2 _ 3 S 3 

3/i 3 p 3 p 

3S X 3S 2 3S 3 


By the use of above equations the partial derivatives of A 12 and A 32 with respect 
to \ , y, p and e are: 
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and 


3A 12 _ 

1 

3 a 

i 

1 - si 

3Ai 2 

1 

3^ ' 

1 - si 

Qj 

> 

»-* 

K> 

II 

1 

3 r 

1-S§ 

3A 12 _ 

1 

3 P 

i" 3 ! 

3A 12 _ 

1 

3 e 

i-s’ 



/ 3 S 

3 S„ 

l + S 1 K JT 

■ a 33 rr 

\ i 

i 

f 3 S 

3 S 

+ S, (a,, - 

- a„ — -*■ 

1 \ 23 3 /3 ± 

33 3 /3 x 







[c Ba 23 c Ba 33 

1 " By " y 3y 

B a 23 g B a 33 


BA 32 

1 

3 a 
1 

1 - S J 

B A 32 

1 


"l-S 2 

3A 32 

_* 1 

3 y 

1 -SJ 

BA 32 

1 

3 p 

"l- s ^ 

BA 32 

1 

3 e 

i- S 3 


1.SJ L \ 1 v z B r : 

.^[. ( S 2 HS 3 )fjH) +Sl (s,^-S 

; ■ -Tij {- <V <V (inr) + s * ( s * - s 

jK £)♦■*(■»£-■»£)} 




(R19) 


In terms of known partial derivatives the standard deviation of A l2 and A 32 can 
be obtained from the following 


r 2 = 
A 1 2 


i = 

h 32 


' 3A >A 2 * 

ij« a i 






(R20) 


3 A 32 \ 2 


' B _M 2 2 


2 PM’ , 

a v * ( 3 p ) 


'3 A ,A 2 

£3) cr 2 

. 3 e I e 
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<B) 


0 < p < 180 and | e ] = e 


As stated in the earth sensor equation section the components of the local verti- 
cal are determined by employing the following three equations for case in which 
0 < p < 180 and j e | = e s 


S x a 13 + S y a 23 + S Z a 33 = " COS a COS ^ 
cos r a 23 + srny a 33 = C 23 

a m + a 23 + a 33 = 1 


> 


(R21) 


In view of the above equations, it is apparent that the variables a 13 , , and 

a are now dependent on the values of S , S , and S as well as y and p . 
Differentiating the equations (R21) with respect to , S y , S z ,y , and p respec- 
tively and making use of the equations (R16) in addition to 




B S 


3 S B S 
y z 


= 0 


B C 


23 


3C 23 3C 23 


3s as as 

x y z 


= 0 


-i 


(R22) 


give the following five sets of equations 


B a 


13 


o S_, 


o 23 ^ 33 

,S .3T tS 'l i - 




= — a 


13 


B a 


cos y 


23 


B a 


BS 


• + srn y 


33 


BS. 


B a 


13 


B a 


13 BS 


+ a 


23 


= 0 


B a 


> 


33 


23 BS 


- 33^=0 , 


(E23) 
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and 


B a 


13 


5 4 s 

* BS y BS 

V 


B a 


23 


+ S T 


B a 


33 


BS. 


=: - a 


’23 


cos y 


^ S 23 - ^ a 33 o 

4 sm y — — — = 0 


BS 


BS 


> 


B a 


B a 


13 '23 , _ f 

BS~ +a 23 BS 33 BS. 

y y 

B a„. B a 


B a 


ii=0 


B a 


13 


+ S 

BS y BS z 


23 


+ S. 


BS 


33 = - a 


J 

~\ 

l 33 


B a 23 ^ a 33 n 

cosr ys - ^ 1 " 7 5s- =0 




B a 


B a, 


B a 


u a 13 w ~23 “ “33 _ n 

13 ^s“ + 323 Ts7 + 33 BS J 

z z z y 


ifH +s i?^=o 

By y By 2 By 


B a 


23 


B a. 




cos y 4 Sin y a 23 sin 7 " a 33 cos 7 


23 

B a. 


^ fl 13 ^ a 23 ~ “33 _ n 

a„ -r — - 4 a„, + a y: - 0 

13 ^ y 23 3 y 33 By 




B a._ B a B a,g 

S ^-+S -^ 3 + s z — ^-=0 

* B p y B p 2 3/3 


3 a 23 . B a 33 d C 23 

cosy- — 4 smy 




B p 


Bp dp 




B a 


33 


^ a i3 ^ a 23 , „ 

a i3 b p + a 23 Bp 33 B p 


= 0 


where dC 23 /dp is given in equation (R13). 


(R24) 


(R25) 


(B26) 


(R27) 
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If 


A = 


cos y sm y 


*13 a l3 


33 


f 0 


then each set of equations (R23), (R24), (R25), (R26), and 
obtain the derivatives 


Let 


Then 


Ba 3a 3a , B a „ 

1 3 i3 i3 i3 


By’ B z By 


B 3 i3 

and — “ ( J 

B p 


P = a 23 sin y - a AJt cos y 


33 


B a 


13 


*13 P 


BS 


B a, 


23 


- a: 


BS 


B a 


33 a 13 COS y 


BS 




13 SJ - n r y 




B S 13 _ *23 P 

BS. A 


23 


- a 


i3 *23 sin y 


BS y A 

B *33 a l3 *23 COS y 


> 


BS 


A 


J 


(R28) 


(R27) can be solved to 


= 1, 2, 3.) 


(R29) 


(R30) 
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Bg X3 _ a 33 P 

Bs. a 


3a 23 _- a !3 a 33 Sin ^ 

BS A 


* a 33 a i3 a 33 COS y 


T? = <“** S * - a 33 V 


Tf = < S x a 33 ‘ S , * 13 > P/A 


T7 = C S y a i3 " S * a 23> ^ A 


3 a i3 d C 23 / 

= < S Z a 23 - S y * 33 ) 77/ A 

^ a 23 , 0 0 _ % d ^23 / 

B p “ (Sx a 33 “ Sz a !3 ) d p / A 


b p cs * 3l3 ~ s * a 23^ d p r 


With the use of the equations (R29) to (R33) and the equations (R6) to (RIO), the 
following partial derivatives can be evaluated. 


B a B S B a B S 3 a., BS 

13 x 13 y 13 2 

BS Ba BS Ba + BS Ba 

xi y 1 8i 


= - (S 3 s 3i + a l3 cos + a 23 sin (s u sec 2 aj P/A 
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3 a i3 _ 3 a !3 3 S X- 3 - a !3 3S y 3a !3 3S z 

3 yS 3S x 3,8 + 3S y 3,8 + 3S z 3,6 


(R35) 


= (-S 3 s 2i + a 13 sin ^ sin ^ - a 23 sin^ cos - a 33 cos rjJ (s 2i sec 2 ^ P)/A 


23 


a 


3S 3 a 3S 3 a 3S 3 a 

xi y i z i 


(R36) 


= (% S 3* + a i3 COS ^ + a 23 Sln (s u 


sec 2 c^) a l3 sin y/A 


3a 23 _3a 23 3 S x _ 3a 23 3 S y 3 a 23 3 s? 
3/3 l 3S x 3,6 + 3S y 3 fi x + 3S z 3^ 


(H37) 


= (S 3 s 2 . - a 13 sin t) t sin^ + a 23 sin 7^ cos £ i +a 33 cos 7^) (s u sec 2 ^ a 13 siny)/A 



Also the partial derivatives of A 12 and A 32 with respect toa , y , and p can 
be derived from the equations (A19) and (A25) and then are simplified as follows 
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In terms of the above partial derivatives, the standard deviation of a and a 

12 32 

can thus be calculated. They are 



(R40) 
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•Conclusion 

This report contains the formulation and the derivation of the attitude determina- 
tion equations, the calculation of the required elements>of error ellipses, and the 
discussion of various possible special cases for the spacecraft Delta PAC. Based 
on the analysis developed in this report, A FORTRAN IV program was written to 
compute the s^cecraft attitude with a subroutme to output the plots of the*error 
ellipses and to indicate the region of possible attitude solution for incomplete 
sensor data. The program was written for the SDS-9300 digital computer and 
was utilized with actual flight data obtained from the Delta PAC which was 
launched on Aug. 9, 1969. ha the course of examining the flight attitude data, 
the program was exercised for all modes of data processing including no sun 
information, with sun information, etc. The results yielded by the use of this 
analysis have determined the attitude behavior of Delta PAC and evaluated the 
spacecraft attitude control system. - The program is essential to prove that the 
flight performance of Delta PAC has successfully met its mission objectives. 
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APPENDIX A 


INSTRUCTION FOR DIGITAL PROGRAM 

The first input card for the digital program contains ten input values in which 
the first one, ISUN, indicates the sun sensor information. All initial conditions 
for the earth sensor equations are specified on this card. If ISUN is zero, the 
spacecraft is in the earth shadow and a run is initiated immediately. IF ISUN is 
not zero, a second input card is needed to read in the values of a x , , a, and 
fi. The value of ISUN determines whether one or two input cards is required 
for each run. The run is terminated when a blank card is read in. A summary 
of the total runs is then listed in the output. 
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APPENDIX B 


************************1,131 1 MG OF FORTRAN PROGRAM *******- 
ATTITUDE DETERMINATION FOR DELTA PAC 
RY A. C. FANG 

DIMENSION E T A ( 3 ) ,SlTAC 3) *CETA(31 *SE(3> -SSt(3) *CSt(3> 

DIMENSION AA1K2) »AA21 (2> *AA3i(2) »AAi2<2> »AA22<2> *AA32<2> 

DIMENSION AA13(4) *AA23l4J J.AA33U) *THU) »TEU) *PH(4) 

DIMENSION NT ( 2 ) » D VS ( 4 ) , D A A 12 l 2 ) * 0 A A32 ( 2 ) 

DIMENSION DAEi3C?)*DAGl3(2)*DARl3(2>*DAc-23l2)*DAG23(2)»JAK23(2) 
DIMENSION DAE33(2)*DAG33(2)*DAR3342)*DAAl3(4)^DAA23(4)»DAA33t4) 
DIMENSION DAI13(2)*UAl23<2)»DAIJ3(2>-»DBll3t2)*LtSI23(2)»iJbi33t2) 
DIMENSION AW l 1 5 ) 

DIMENSION lA(9u»5S>*Iti<y0.55> 

COMMON C23»lA*Id*K0MD*IDAY*niM 


c**** * def IN£ the variables 
c 

C***************' 

C VAR 1 

£***it*'****'****-J*-* ****■: 

C .RADIUS OF tARIH 

C RE 

C*****-*x** , ** - *:fc , *****'******T 

C QIMBAL ANbL£ 

c UA 

0 **'***Tlr****'i:*x'***‘***'* * * * 

C HALF earth pulse 

C ROMD 


:*********«************ 

UNI I 

r*#*****’***** - ***********'**'* 

N . M . 


VAR 2 

:*********! 

ORdI I AL ATI I 1 UltE 
H 

!**»*********************************************** 
SCAN CONt HALF ANdLE DcGKlL 

SIGNAL) 

r************************************rt******** 

ELtCfROML SATURATION UEGKll 

ED 

C******************************************************* + ****'*****"*******'******* 
C TELEMETERED pitch ERROR GEOMETRICAL PITCH COMPUTED cKRBR DEGRtE 

C ETD 1 hE 1 AS 

C********»****************************************************************’'*****' 
C ORPITAL POSITION aNGLE EAR T H SUdiENDEO AN^Lc. IhmlF) Dc.GKll 

C DALFa AlFAL 

C ANGLc BETWEEN ORBIT PLANE AND EARTH SUN LINE uc.uKt.d 

C DdLfA 

c******************************************************************************* 
c azimuth Elevation dluklc. 

C ALIj BTID 

C***^**********^**-********'**K****->l 1 r*****-)r******-*****-*********->l****************** 

c 

C CONTINUE 

C 

CxffX**~k***'x**-k***********-***-K********tr*****************’'*********'************** 

C************^****-***-k***-k***y,«*************-k-i<******-»***********f:*****-y**->’f^*^** 

C BODY AXES * 

C X Y 2 

C■x■**■<'******■***•****■x-x*-' + ****■***■k■x■k****■***t*********i<*■****•*******^****• | '*^******^***^** 

c RIGHT HANutU SYSTEM FOR SUN St>\SOR HtAu 1* I = l*?»3. 

C El FI 

C ******************** Jr************************** - **************'** 1 *****'* 1 ********* 1 * 
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c 

c 

C* 

c 

c 


ANGLE BETWEEN Y -1 PLANE AND PLANc. CONTAINlNC £1 AND L 

SEl St2 SE3 DEbrttt 

rit‘fr******jk*;kTfr***7****jt*****-**fc-A^**Tt*T****tfr**** , ******* + *'Jirx**f**A*^''*.*1frik*:r*ifc*** 

ANGLE bETwEEN El AND X-Y PLANE 

ETADl ETAD2 ETA03 . Dl&REe. 

f ********* 


C****************************-*****W****************-w********i 

C C9SINE OF ANGLE BETWEEN SCANNER GONE AXIS AND LOCAL VLT1CAL’ 

C C23 

C DIRECTION COSINES OF THE LOCAL VETICAL W.K.T. THE BODY AXES • 

C A A 1 3 A A23 AA33 i 

C DIRECTION COSINES Or SUN-LINE W.K.T. I TH SUN SENSOR SYSTEM* 

C ST SU SV 

C DIRECTION COSINES OF SUN-LInE W.K.T. THE LOCAL VERTICAL SYSTEM 
C SI S2 S3 

DIRECTION COSINES OF SUN-LINE W.R.T. BODY AXES 
SX SY S L 

:**************■*******************************************■****** 

DIRECTION COSINES OF ORB I f NORMAL W.R.T. ThE BODY aXlS 
A 1 2 A22 A 32 

DIRECTION COSINlS OF VlLOCIIY VECTOR W.K.T. the' BODY AXES 
All A21 A 3 1 

t******************-*-#****************************************************** 

ROLL ANGLE PITCH ANCLE YAW ANCLE 

TH Tl Pn 

C************************-****'*******'***'***************************************** 
C ERROR ESI IN Ale. IN ETD,bAMAD,KOMDj AlID,bTiD ARE 

C DET UC’A dKM 

C DALI Db f I 

C************’*’*****'***'******* - ***********************'*'*** - **'*************’********* 

c 

C**-***DERIVAT 1 vbS 
C 

C***'W-******'**x*********x******>ir********ft:K***********'*-**x*'***** *'* **************** 

C V A R J VaK 2 V A K 3 N0T£ 

0 ***xr*********************************************»r*****************w*********** 

C PARTIAL DERIVATIVE OF SX.SY AND SZ W.K.). ALiD 

C DSX A OSYA ObZA 

Q* * + * * * ****** * Jr * ********************** x * #*■**■** it ******* <t * Is ***** * *'* **■*»*■* x ********* 

c partial derivative of sx.sy ^li s*z n.h.i. btid 

C DSXB DSY» US/.B 

Q***x***'****r****************-*** , *******-*****************************“*******'****** 

C PAR1IAL KcRlVAIlVt OF A 1 3 I 1 > » A2 J ( i ) » A33 ( 1) W.K.T. SX ARE 

C A X ! 3 i A X 2 3 1 AX331 

C********************** + **-jr**************r****«*************r*****i**************** 

C PARTIAL DERIVATIVE OF A13(2>.A23(2).A35(2) W.K.T. SX ARE 

C A X 1 *52 AX232 "A X 3 3 2 

c ******** *■**•* w *********■*****"**»********■♦*****■* * * * * x * * ***** + ******•***■.********* * * 
C PARTIAL DLKIVAIIVd of A13 ( J ) . A23( 1 )> A33 l 1 ) W.K.T. SY ARE 

C AYQl A Y23 1 AY331 
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f * x *- * * * : 


• * * * * x i 


C PARTIAL DERIVATIVE 8F A i 3 ( 2 ) , A23 { 2 ) * A 33 l 2 > rt.R.T. SV Ak£ 

C AY132 AY232 AY332 

C*******************************-*** , ******* + ***************'ir*>fc***‘±**************Te 

C PARTIAL DERIVATIVE SF A13( n »A23(1 J»A33(D rt.K.T. $£ A R£ 

c AZ131 AZ231 AZ331 

C*****************X*************-K*******************#** x + * + ** x **»*************** 

C PARflAL De.R I V A T I VE OF A 13 l 2 > ■> A23 ( 2 ) * A33 I 2 ) w.R.T. S3 ARE 

c AZI32 AZ232 A4332 

C****«********************«**********-*#*T***rt-*******^**-********i't**r*-******i.**4***- 


c 
c 

C * * ' 

c 
c 


PARIIAL DERIVATIVE OF A 1 o U ) , A 23 (I ) . A33 (i J W.R.T. ALiD 
DA 1 13 ( I ) DA 1 23 ( I ) DDA133U) 

PAR'I IAL DERIVATIVE OF a! 3 U ) - A 23 (I) * A33 ( U w.R.T. UUD 
Ob 1 1 3 ( I ) DUl23(l) DU 1 33 ( i ) 


C*****-*************-*-.*****'******'*****************: 


! * **★******•**★***#*■*★ 


c 

c 

c 

(i* * 

c 

c 

c 


T, 


ALI3.UTlL),ETu,bMMAO,R0MD, 
U£ 12 


Al_lL.bFID„tTD,bAMAD.ROI v !U, 

DE32 


ARE; 


AKE ; 




PARTIAL DERIVATIVE of A 12 W.R. 

D A t 2 Db 12 

OG 1 2 uk!2 

•lc*-*****lk***W**********-<[******)tl 

FAFT1AL DERIVATIVE OF a32 W.R, 

DA32 D332 

DG32 DR32 

C * + '''****** * * * * X *****'***■***•*** -X + ■*****■* X •* X * * * ■*** + + **■*** ± * ■***•***■** X *********** *•**•* * 
C PARTIAL DERIVATIVE; OF A13( I ) * A23 ( I ) .» A33 l 1 > vi.K.T. ElD 

C DAE13U) DAL23U) DAe.33 ( I ) 

C»‘*****s***********K***it***iHi***ilil*****»**4 

c partial derivative 

c aAGl3ti) 

C PARTIAL uERIVATIVL 

C DAR131I) 


x*****<it*«**«*ii*ft****w*****^**5U 


C**-******i 


OF A131 I ) » A23 ( I ) • A33 t I ) 
DaG 23 t 1 ) 

OF A 1 3 ( I >,A23( I )pA33( I ) 
DAR23 : I ) 


rt.R.T. bAMAu 
OAb 33 < 1 ) 
W.K.T. KOMD 
DAR33 l 1 > 

*★* * ) 


C**-***ST0RE IMPUT DaTA .AND S I ART I he. CALCULA f ION , 
C * * * * * 


DATA RE/3448.0/ 

DATA R AD. P I /,j. 31745329*3. 14x69265/ 

DATA SIoMAD,£D/ 45. u* 45.0/ 

PATA ET ADi* £ T A D2»£T AD3/26 .uS* 26 • u6» 26 • 25/ 

DATA SE1j5c.2*S£3Yu* 07^ 12u. 06 . 23 9 . 6 / / 

DATA DE I »BG>A*. JKrt* BALI* DbTI / .017453* .UUS73> .017453-* . 017 453* .0 17453/ 

MRuN=0 

TD 1 F = y . u JO 1 

E = ED* RAD 

SIGMA=S1GHAD*RA0 
S£ ( 1 ) =S£ 1 *P AD 
SE ( 2 1 =SE2*R AD 
SE 1 3 I =Sc3*RaD 
ETA ( 1 )=t i AD1*RAD 
tTA(2)=ErAD2*RAfl 
ET A ( 3 ) =tT nU3*RAD 
S'ib = SIN ( S 1 b M A ) 

CSS=COS( SIGMA) 

DO JO i = t * 3 
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SSt( 1 )=SiN(bt( n ) 

CSt ( ! ) = CbS i Sc ( l > ) 

S E T A ( 1 )=slNlc.T/‘(! ) ) 
rET A ( 1 )=Cub(tTA (in 
!j CONTINUE 
C ***** * 

PEMJ jjf I oUN, GA 'IAi)*£l G>rlt/MU» 1 1 /mY» LHK*f1ilM» 1 StL* I 

C * * Jc * * * 

3 _ FORMAT (12*P12«fc»Fl4«©»FiA.<J»l4»l4.i4»l4»Ib-*Ftj*3) 

I r (10.cU.wI GO r o 99 U 
1 f 1HRUn.lI».uI (.•’9 r<3 40 
Jr ( I3H .f\t.I3) bb rt 99u 

4 C I riM=lHr<*jciJJo + lv tii\* r l , .*J+li>^C 

PRINT b ^ 

PRINT Su* iDAY* I -Ik, MIN, ISt-C* lc»h 

S'J F8rtMAT<i.X,$ DAY = #,14,$, Hk = $, i 4,$j, MiN=$,l4.$» bEC = #,U* 

1$. 6ri3ll=#*U,iX^» r= #,Fi0.4,/> 

A4( 1 )=I0AY 
AW(2)=IliR 
AN ( 3 > =M 1 N 
AW (4 ) = I SCC 
A a ( 5 ) = I C> 

AW(6)=&AilAU 
A". I 7 ) = R3Mb 

A n ( 8 ) = J - J 

AN(9)=cv 
A W ( lul^’j.U 
AW ( 1 1 ) =o.O 
AW ( 12 >=u.O 
AW( 13 )=u.O 

ALFAt = AblN (RE/(RE+H)} 

ALFAL = AlF At/R AO 
Si')A=S I N l AL p At ) 

psa = cos (alfaE) 

C4PS = CSb(ALpAt + SlbilA) 

CAMS=COS( ALFac-sI oHA ) 

PRINJ 6U 

6‘J FORMAT ( J X, #■«**********#,/ ) 

PRINT 70 

7J FORMA T ( ix 4^A *T H SeNbOK i iviFOkMA i I ON blVcbi$*/J 
PRINT 8j* bArTAD^ET JjKO-MlJ 

80 FSRMaT ( ix»^ Oa/IA ( In utbRtt ) =&, F t J . 6* $, EMIN JjtbRtt ) =$, 
lFiJ.t'»$* KftMliW OcbRLfc 1 =$, Fl 1 - o* / ! 

GAMA = GjAI 1AU*KAD 
ET=ETH*RAD 
R3M=R(JMD*RAD 
CSG = Cefb (bAlA! 

SNG=SIM(GmMA) 

SNR = S 1 N ( Kdl'i ) 
csR=cestKtjM} 

T.\G = SNG/CSG 
D3 9 J I=l>2 
D At 1 3 ( I) =0.0 
JtAc23 (11=0*0 
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DAE33 ( I >=0-0 
DA&13 ( I )=0.0 
DAG23 ( I ) =0 .0 
n AQ33 (I )=0.0 
DARI 3 ( I > =0 .0 
DAR23 ( I )=0.0 
DAR33 l I > =0 « t) 
DA 1 13 ( I >=0-0 
D A 1 2 3 ( I >=0.0 
DA 1 33 { 1 ) =0 • 0 
D8I I 3 ( I >=0.0 
DO 123 ( I >=u.o 
DS 1 33 ( I >=o.o 
DAA13 ( I 1=0-0 
DAA23 ( I > =0.0 
DAA12 > I >=0-0 
DAA32 ( I ) =0 .0 
gr, continue 
C T 1 = C . 'j 
C T 2 = J . j 
FAL = J 
FAL=U .0 


FBT=0.0 
FBT=o.u 
’ L£ = 0 

C************-****: 

C*PARr 1 *APPLiCAll^N C?F £ A R 1 H StfvS&rc 


r*********w****** * 1 


:***■**•* 


C**-**'******-***-*****’****‘***‘** , *********************'*’*********'*'** ac ★ *-***-**★* 
AE I = AOSF C El ) 

IF (ROhQ.tG. 1S0.‘J> GQ T& 160 
IF (R6MD.EQ.U. j) t,0 10 170 
IOC, CB=CSS*LSA 

C J=SNS*bNS*SNR*SNR 
CA=1 -O-CD 


OC=SNS*CSR*SORTF(b>NA-SNA-CD 1 
C23=ICb-CC) /CA 
hRC23=J -C23*C23 
SRC23=SuRrF(RRC23) 

D'MC23 = “RKC2 3*SN5*bNP*i)RN 

DDC23=CbR*SNS*L23-CSb*SRC23 

LE=0 

I F ( D D C 2 3 .NE. ..0) ie 11U 


LE = I 

Gt TO 120 

110 DC23=DNO23/0DC23 

i?G F S = A M 1 N ( ROM* P I -ROM* l ) 

IF ( AET.L f.Lb) bo 10 130 

C x* ******** ** WHEN ASbr ( l 6$ ( ROM ) ) < 1 bill At 1 = ES PUT LP = 0 
LP=U 


NLP=0 
GO TO 1 8<J 


130 LP=3 
ML B = 3 


ASbF ( OOS 1 ROM > ) <1 


ANLi AtKES PUT lP=3 
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C*****fALCULATl&N UF A13.A23.A33 rthclM < E T ) la N01 tuUAL TO u 
THETAS=ET 

C ThETAS=GEbMETRICAL PITCH COMPUTED ERROR (- i 80< f HE1 A$< i 80 > 

SNT=SIN(THETAS) 

CNT=C0S(Tht!AS) 

AA13U ) =bl\T *3 kC23 
AA13<2K=~AA13U ) 

AA23<1 >=C23*C$G+SRC23*SMG*Cr'jl 
AA23 (2 >=C2 3*CSG-SKC23*SNG*bM I 
AA33 ( 1 )=C23*SMG-SRC23*CbG*Ci'il 
A A3 3 < 2>=C.23*SiNb-t-SKC20*CSG*CNT 
AA13<3 )=aa 13( n 
AAi3<4)=AA13(21 
A A23 < 3 ) = AA 23 ( 2 ) 

AA23<4)=AA23l 1) 

AA33<3)=AA33(2) 

A433(4)=AAo31 1) 

P6 140 1=1-. 4 
1H< I }-Ai>iN i AA23( 1 ) )/RAD 
TE < I ) =A I aN l-AAl3 ( I >.AA33< I > ) /RAD 
14L C 0 N riwUE 

IFCLt: .Eu. i) GO ro 180 

C***+*CALCULATE bTAMDARD DtVlATlbN CF A13.A23.A33 
ilAtlol 1 )=i>RC23*CNT*Dc.r 
flAc 1312)=-DAE13( 1 ) 

D A G 1 3 ( ) 1=0-0 
DAG ) 3 ( 2 ) =0 *U 

HAR] 3 (t) =-C23 *Sn1 *UC23/SKC2o 
[>ARl3(2)= =_ DARl3l 1 ) 

DAE 23 ( 1 )=-SKC23*Si\iG*SNl*DET 
))Ac.2J12)--1jAc.23( 1 ) 

D A G 2 3 t 1 1 =- 1 A A33 ( 1 ) ) * DO A 
DaG 23(2)= _ <AA33(2) > * DGA 
T AR23 < 1 ) = (CbG-C23*SNb*CMT/SRC23)xuC23 
l 1 A R 2 3 ( 2 ) = (C$b+C23*Sf',t*Cf\n /8RC23 )*DC23 
!) A E 3 3 ( t )=bKC23*CSG*SN r*DEl 
DAh33( 2 )=-DAE33( 1 ) 

DAG33( 1 ) = ( AA2 3 < i ) )*DUA 
])AG33(21 = (AA23<2) )*DbA 

D A R 3 3 ( 1 ) = (bNb + C 2 3*CS b* Civi T/8RL23 ) *DL23 
DAR33(2l = l* N 'b-C23*CoG*CiMl'/SRC23) *UC23 
1.0 150 1 = 1.2 

I) a A 1 3 ( I J=&uRTFiDmc. 13 ( I / ^*2 + DAKl3l I )**2 + i)Abl3(l 

fiA A 23 ( I >=bURTF( JAE23 ( I ) **2 + UAk 23 l I ) **2+D«b23 1 1 ) **2 ) 

DA A 331 I ) =oURT F( D At 33 1 £) **2+0 aK 33 1 i > **2 + DAG33U > **2 1 

ll A I 1 sj { I 1 =0 - 0 

r- 3 1 1 3 < l ) = u • o 
DAi23( I ) =0 « v 
JH1231 I )=j.(J 
DA 1 33 t 11 =U- J 
Re! 1 33 ( I ) =U - u 
1 5 j continue 

r a A 23 ( 3 ) = bAA23 l 2 > 

DAA23<4)=bAA2oCi > 
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DAA33<3>=DAA33(2> 
DAA33< 4 >=DAA33 ( i ) 
G9 TB 1 8L> 


C * ■* * * 

C******** *** "vr-icN CCS ( i<8M ) =- 1* PUT LP=2 10 PLOT i HE REGION 
160 l.P = 2 
MLP = 2 
C23=CAHS 
SQ 13 18j 

c******** «** ^hln c83(R8m>=i put lp=i (e plot t he region 
1 7u LP=J 
MLP=1 
C23=CAPS 
GQ TO 1 do 


C*PaRT 2 •••*••»•••• SON SeNSSR 

C** + *'*f*»r****'*’ , w' 3f '*'**^*** , *J<'***’ 


t * * 1 

APPLICATION 

:**»x**! 


18o IF l ISUN.EO.j) Go To 590 

c ***** + 


READ 1 9U* ALIC*OTID»l)ALFA*DStTA 

c* * * * * 

190 F0RMmT<6F14.8) 

A L I = AL I iJ*RAi5 
PTI=8TIL*RAD 
TAl = (SIN(ALl) )/C3S(ALi ) 

Ts3I=(SIN(bT 1)) /CO S ( 8T i ) 

TAd = SWRTFl I.-J + ( TA j ** 2 ) + ( TB 1 **2 ) > 

SI =1 .0/ I Ad 
SU=TB I / I AB 
SV=TAl/TAd 
PRINT 60 
PRINT 2'JvJ* 1 Sun 

200 F8RHAT ( IX, $1SUN=$:, 12*$.. Sun StNSbR iNFORHAllON GIVES:#../) 

PRINT 2 10* AL I D* d HO 

2IU F0RMAT ( 3X»$AZ I NU TH=$*F 1U.5*$ Ufcfc>» - ELEVAT 10N=$* FlO . 5* $ uEo.#*/) 

PRINT 22j*ST*SU,SV,DALFA*DBtT A 

22 j F6RMA T< 3X*$S1I=#,F9.6*$* S2l = $J»F9-6.$* S31=$*F9.o, 

J$, A L p A ( IN DEGH££)=$[»Fil.6*$* BeIAUN DEGREE ) =$, F 1 1 . 6* / ) 
ALFA=DALFA*RAU 
BET A=DBETA*RAD 

C*****C ALCULA I C i HE DIRECTION COSINES 8F SUN LINE W.R„T. bQLY AXIS 
J=I SLN 

S X = -ST*LET A ( J ) *3Sc ( J )+SU*SETA(j > *S3t (J ) -3 V*CSE ( J ) 

SY = ST*CETAU)*CSE ( J)-SU*S£1 A( J ) *CSE ( J )-SV*33t l J ) 

SZ = -ST*SE1 A(j)-SU*CE1A(J ) 

PRINT 230* SX * S Y* SZ 

230 F 8RMAT ( 2X* $ HE D 1 REC T I 8N COSINES 6F SUN LINE W.R.T. SPACECRAFT 
fAXES ARE #*Fi2.d*$* $*Fj.2.8,$, $*Fi2.S*/> 

C*****CALCULA1 E PARTIAL DERIVATIVE OF 3X* S Y* AND SZ n.R.T.AUD AND dill) 
S£aI = 1.-0 + TAI*TA| 

SEB1=1. J+TBI*1 BI 
STea I =S1 *8c.AI*DAL I 
STSBi=ST*Stal*DBTI 
nSX^={-SX*SV-CSE(J))*STSAl 
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DSXd = l-SX*SU+SE TA ( j ) *SSE ( J ) ) *bl Sal 

IIS Y A = ( - S Y *SV-SSE(j > )*S1 $aI 

nSYB=C-SY*SU-StiTA<J)*CSElJ)>*bTS8I 

nS£A s: -S2.*sV*S7bAl 

ns £ 3 = ( -bZ*SU-CE U ( J ) »*bl SSI 

*****CALCULA re I HE DIRECTION COSiNtS OF SUN LiNE rt.h.l. GlOCEMRIC AXIS 
Sl = ~C8S(BtirA)*(blNlALFAJ ) 

52- S 1 N ( bEI A ) 

53- -C&S(8tlA)*(C0o(ALFA) ) 

PRINT 2aj»Si,S^ .So 

P R 1 n T o 0 

24-j FORMAT ( 3 X * § T H E DIRECTION COSINES OF SUN LINE rt . K . I. GEOCENTRIC AXib 
i i S*F 12.d> $»F 12-S»#.» F 12.b> / ) 

IF(lP.Eo.J)G 0 Td 250 
GO TO ( oi u*6l U» 450 > *LP 

*****CALCOLATt I" HE LOCaL VERTICAL WHlM tt=£S. 

2^0 SYSG = SY*Si\G 
SYCG=SY*CSG 
SZSG=SZ*SNG 
SZCG-SZ*CSG 
FCC=SYS&-bZCG 
IF <FCC.EG.O.O>GO TO 280 
F CR = F CC* *2 
F A=SX* SX+FCR 

F6=SX* ( -S3+C2S* ( bXSfc+SYCb ) ) 

FC = FLK + 2.0*C2J*33*(SZSG + SYCG)-$J*S3-C23*C23Ml.a-bX*SX> 

R 0 T = F B * F a + F A * F C 
IFCROI .LI . O.j) GO TO 260 
A A 13 I 1 ) = (-F b + 3uRTF(K9 f> ) /F a 
AA 13(2)=(-Fti-SGRTF(R0T) >7 FA 
A A23 ( 1 J= (SMS* (S3-SX*AA13 ( 1 ) ) -C23*S Z ) /FCC 
AA23<2>=(SNG*{S3-bX*AAl3<2) ) -C23* S Z ) / FCC 
A A331 1 > = (CSG* ( -33+SX* A A 13 l 1 ) ) +C23*SY >/FCC 
AA33(2)=(CSG*(-S3 +SX*aa 13(2))+C23*SY)/FCG 
GO TO 32u 
260 PRINT 27-J 

270 F0RMAT,(3X,$A13* A23* A33 ARE NO J REAL NUMBER. THEREFORE^) 

GO T 6 42u 
280 PRINT 293 

290 FORMAT ( 3X J .$SY*SIN (GAMA ) -SZ *COS ( G AM A ) =0$.. / ) 

lf (Sx.eo.u.u)Go ra 420 

C TRY TO UbE OTHER METHOD FOR bEtKlivfc THfc SOLUTION OF A13*A23,A33 

A A 1 3 ( 1 > = (S3*CSG-SY*C23) /Sx*CSb 
A A 1 3 ( 2 1 =AA13 ( 1 ) 

R6B7 = 1.U-AAI3{1>*aA13UL)-C23*C23 
IF(RO0T .LT.U.OIGO 10 260 
SGRR=SGRTF(ROOT) 

AA23(l>=C23*CSb+SNG*SQRR 
AA23 l 2 ) =C23*CSG-SNG*SURR 
A A33 ( 1 )=C23*SNG-CSG*S0RR 
AA33 (2 >=C23*SNG+CSG*SURR 
PRINT 3UU* AA131 1 ) - AA23 ( 1 ),AA33ll > 

3r>C FORMA! (oX,$A13d )=§,r 11 . A23 ( 1 ) =#. F 1 1 . 6 , £, a33 <1 ) F 1 1 . 8, / ) 

PRINT 3lU»AAl3(2)>AA23<2)jArt33<2) 
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non 


310 FBRMATt JX,§Ai 3 ( 2 )=§,Fii A23 ( 2 ) =$. r 1 1 . ii*Q* A3 3 I 2 ) =&* F 1 1 . 8, / ) 

C* •» * * * 

TEST IF Alo SATISFY Tut CONU i T 1 0 N FOR THE REQU I Rt.il REGION 
TL.TM ARE THE LOWER LIMITS F6R 1 He. TWO POSSidLt RtSiONS 
UUTR ARE IhE UPPcR LIMITS FOR THE T /J 8 POSSIBLE REGIONS 
320 TL=SRC23±SIM£S> 

TU=SRC23 
TM=-TU 
TN=-TL 

ne 340 1 = 1*2 
CK=AA13{ I ) 

I F { ( CK .GE. 1 L. ANQ.CK. LE. Tit ) .OR. ( CK.GE. TM. aND.CX.LE.TN ) ) bO let 330 
NT ( I ) “0 
GO TO 34_> 

33’J MT < 1 ) = I 
340 CGNT l NUE 

M N T = A M I N (NT ( i ),N f (2 ) I 
KAl=AMAX <NHl),Nr(2)) 

PRINT 3GU, AA13 ( 1 ) . AA23 ( 1 ), AA33I 1 ) 

PRINT 3ib.AAl3(2),AA23<2),rtA33t2> 

PRINT 00 

PRINT 3b‘J, I Li FU» Th, T N 

350 FORMAT <3X,§Nb TE I A13 HAS TO SATISFY THc. ReUOxReIJ CONDI I I ON FOR 
1 THE LIMITED REGION, $,F 8 . 5 ,$ < *13 < #■» Fa . b-» 6 R,$,F 8 .b.» 

2$ < A 1 3 < $,Fa.5W ) 
i F ( MAT .NE.MN f ) GO 10 370 
PRINT 36j 

360 FORMaT (3X,$THe T*0 SOLUTIONS OF a!3 DO nGT SAfISFY THE CONDITION 
IFOR The REQUIRED KElION &,/) 

GO Tb 420 

370 Tri( 1 )*ASlN( AA2ol 1 > ) /RAD 
1H(2 I=a*iNIAa23(2) I/HAD 
T E C 1 ) = AT AN (-Aa13(1>,AA33(1)>/RAD 
1 1 1 2 1 = A I AN I-AA13(2),AA33(2) I/RAD 
PRINI 38-J, Th ( i ) , 1 £ ( i ) 

35 J F0RMAT(3X,|R0LL ANGLE 1H{ 1 )=$»Fl0.5»$ DEG., PITCH ANGLE 
tFlj.b,&DEG.|./> 

FRINI 39 J, 1 H ( 2 ) * TE { 2 ) 

39C FORMaT (3X,^R0i_L A.vGLE T h < 2 ) =#» F i v . 5 , $ DtG . , P IT Ch ANGLc. TE(2)=$» 

1 F I l . b,& UtG .§, / ) 

IF(LE .£0. i) GO 16 45U 

c***** calculate partial differentiate gf ai3.a23,a33 w.r. f . sx.sy,s 4 »eil 

C*** + * A N U LALCULATt STANDARD DEVIATION OF A13»A23,A33 
SAIol=AAi3(i)*AAi3(H 
SAi32=AAl3(2)*AAi3<2) 

CFR1=SNG*AA23 l i >-C3G*AA33 ( 1 ) 

CFR2-SNu*Aa23(2)-CSG*AA33(2) 

CDNl=SX* ( -CFR i ) +FCC* AA13 ( 1) 

CDN2=SX*(-CFK2)+FCC*AA1312) 

I f ( CUN 1 .EQ-u.O ) GO Tb 400 
AXI31=CFR1*AA13U l/CDNl 
AX23I = ~Si'tb*SAI3l/CDNl 
A X33 1= CSb*SA 13 i/CDN 1 
A Y I 31 = CP Ri * A A23 (1 J/CDNI 
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AY23I = -Si'fG*AMlo(l)*A>23(l)/CDMl 

AY331= CSb*AA13ll)*AA23(l)/CDMl 

AZ131=CFR1*AA33 tl )/CJNl 

AZ23l = -SNiG*AA13 i 1 ) *AA33( 1 ) /CDM 

A Z33 1 = C$G*AAL3 ( 1 > *AA33 C 1 ) ZCDNl 

RG131=(SZ*AA23( 1 )-SY*AA33(i) )/CDNl 

RG231= ( SX*AA33 ( 1 ) -S Z*AA 1 3 ( 1 > WCJN1 

I) A G 1 3 ( ) )=CFKi*k^l31*ijGA 

D A G 2 3 ( 1 )=CFRl*Ku23l*DGA 

DAR)3( 1 )=Hb'i3i*DC23 

DAR23( 1 J =K G23 L » i)C2 3 

DA I 13 ( ! ) = AX1 3 1 *ubX A+A Y 1 31 *DS Ya+ A Z 1 3 1*DSZ A 
P A I 23 ( l ) = AX231*USXA + AY23i*uSYA + AZ23i*DbZA 
DAI 33 ( 1 )= AXo3i*r)SXA + AY331*D3YA + A2331*DSZA 
Del i 1 3 ( 1 )= AXl 3 i*C^Xd + AY 13i*uSYb + AZl 31 * ijbZcs 
DS123( 1 > = AX231*DSXd+AY231*DSYB+AZ231*UbZB 
1)81331 t)= AX33i*DbXB + AY33l*DbYts + AZ331*l)bZB 

DAAJ3(n=SURTFli)Ali3(l)**2+uc!ll3U)**2 + uAbl3U)**2 + LARl3(i)**2> 
DAA23 ( 1 )=b GR IF < DaI 23 tl )* *2 + D8 123( 1 ) **2+0AG2J H) * *2 + 0 Ah 23 U ) ** 2 > 
D Ad 1 3 ( U=0-o 
DAE23 ( ! ) =U .0 
FJ AE33 ( t )=U.O 
G 3 T 3 4 i J 

c * * * * * 

400 LE=2 

4J0 IFICDN2 .EU.o.O) 69 T9 440 

RG132=(SZ*AA23F2)“SY*AA33(2))/CuN2 

RG232=(SX*AA3o (2>-SZ*AAi3{2>>/Ci)N2 

DAG13(2»=gFk2*P^132*L)GA 

DAG23 ( 2 )=CrK 2 *R 6232 *UGA 

DAR13(2)=Ri=132*DC23 

DAR23(2) = RG232*DC^3 

A X 1 32= CFR2*AA1312)/CDM2 

A X232 = -BNG *3 a 1 32/C DM2 

AX332= Got,*SAl 32/CLJN2 

A Y132=CFR4*AA23 12) / CUN2 

A Y232 = -bNb*AAi3 t2) + AA23 ( 2 )/CFj(m2 

A Y332= CSb*AAlo(2)*AA23(2)/CDi42 

aZ132=CFR2*Aa33<2) /C0n2 

AZ232=-bRG*A*l 3 (2 ) * A«33 l 2 > / CLM2 

AZ332= tbb*AAl3(2) *AA33(2) /CLN2 

PAll3(2>= AX I 3 2* Do XA+AYl 32 ' OS Ya+aZI 32*032 A 

PA12? <2) = AA23<;*LlbXA + A F23^' , U&YA + AZ232*0b4A 

DA 133 (2) = AX332*ubXA+AY332+DbY X+AZ332*bbZ A 

Dyll3(2)= AX132’'DbXd + AYl32-»DSYa + AZj32*DbZti 

DO 1 23 (2) - AX232*DSXd+A Y232*DbYb+A4232*DSZb 

D3133 (2) = AX332*UbX6+AY 332* DbY ri+AZ332*USZd 

, n AA13 < 2 ) =SuR f F ( JA 1 13 (2 ) **2 + Dfci 13 ( 2 ) **2 + DAt-13 ( 2 ) *a 2 + UAR13 ( 2 ) **2 ) 
DAA23 ( 2 )=oORTF OAi23l2)**2 + uol23(2)**2 + DAG23(2)**2 + DAR23(2)**,i) 
DAE 1 3 ( 2 > =U *0 
DaL23(2)=J.J 
DAE33 ( 2 ) =0*U 

PRINT 4»U*UaA13( 1 )*UAA1312> 

PRiiMf 4 9 0* DAA<i3( 1 
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PRINT 60 
GO 19 45U 
PRINT 430 

4,1b FORMAT t SOLUTION FOR A 13.. A23* A33. TRY To USE PuOTg,/) 

MLP=1 
GO TO 6 l'J 
442 LE-LE+3 
C * *■ * * * 

C*****CHECKINb aHICH ONE. OF THE LoChL VERTICAL SHOULD bit StLEC TED 
C K = i SR 2 MtANS 0N t ANSWcR F OR LOCAL VERTICAL-. K = 3 Mt AKiS Twti. 

46 c 1 D0 = 2 + < LR+1 ) /2 
DO 460 1 =i * IDO 

CHECK 1= (AA13(I))**2+(AA23d) )**2+( AA33 (I) )**2~i .0 
CHECK2=UA23( I ) )*CsG+(AA33( I ) >*SNU-C23 
CHECK3=SX*AAi3 l I ) +3Y * AA23 I I ) +SZ*A A 33 U ) -S3 
DVSl r )=AMAX IAB5F( CHECK 1 dABSplCHECKS) » AbSF(LhtCK3> ) 


460 CONTINUE 
PRINT 60 

A S V = A M I N CDVSI 1)> JVST2) ) 

IF(LP.tU.j) GO TO S1U 
A 3W = A MIN ( OVS ( 3 ) . UVS ( 4 ) ) 

1FIASV.lE.ASW) GO TO 470 
A 423 ( 1 ) -AA23 ( 3 ) 

AA23(2)=AA2314) 

A A33 ( 1 ) - AA33 ( 3 ) 

AA33(2)=Aa33(4) 

TH(1 ) =TH ( 3 ) 

TH(2)=TH(4) 

TE(1 ) =TE ( 3 ) 

Tt(2>=Tt(4) 

A S V = A S W 
D VS ( 1 ) =D V b ( 3 ) 

DV3(2 )=DVS(4) 

470 PRINT 30u* AA13 ( 1 ) .AA23( 1 J.AA33 ( 1 > 

PRINT 31u* AA1JU>*AA23<2>*AA33(2) 

PRINT 30‘J* T H ( 1 ) > I E ( 1 ) 

PRINT 3yj>TH(2)jpTt(2) 

PRINT 60 

1 F ( LE.EO . 1 ) CO TO 510 
PRINT 60 

PRINT 480* DAA13( 1 ) -DAA13 (2> 

4 A-j F0RMAT(3X»$DEV IATION IN A13* UA1 3 C 1 ) F8. 5* S* 

PRINT 490* 0AA23( i),0AA23(2) 

49C F8RMAT(3X»§DEVlAri8i\ IN A23* UA23 11 ) =$. F8 . 5* $ * 

PRINT 500*uAA33 ( i ) »DAA33 (2 > 

500 FORMAT ( 3 X* §DE V IAT ION IN A33* DA33 U ) =$» F8 . 5* 

PRINT 60 

5)0 niF=ABSF(DVS( l )-DVS(2) > 

IF(DIF.LE.TDIF) GO TO 550 
IFIASV.tO.DVSU) > GO TO 520 
K -2 

GO TO 530 
520 K = 1 

53C IFILP.EU. 3)G0 TO 570 


DAi3(2)=$*F8.5) 

D A23 T 2 ) =$.» F8-5 ) 
DA33 l 2 T =§* F8.5 ) 
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I F (NT ( K ) ,tO.K ) ije 19 570 
A <*J ( 8 9 =T H ( I ) 

AN (9)=TE( 1 ) 

AW ( 1 1 ) =THC2 ) 

AW112)=1E(2) 

PRINT 54u 

40 FORMA! ( 3X,£THE POSITION OF rtl3 DOES NBT SATISFY T HE KtQUIRtiD t_ 1 n 1 T 
IREGI0N#*/ ) 

(.0 IB 42 j 
50 K = 3 

IF(LP .£0. 3) Go 10 o60 
IF(MNT.NE.09b0 rO 6 1 j 
IF (NT { 1 9 .EU.-J) OS 1 0 5t>u 
K = 1 

GO TO 57u 
.50 K =2 

>70 A13=AAt3(K) 

A23=AA23(K) 

A 3 3 = A A33 ( K ) 

V Ac 1 3 = D Ac 1 3 l K ) 

V*E23 = DAE23 IK > 

VAc33=DAE33 <K > 

VAG13=DAG13 (K ) 

V AR 13=DAR I 3 ( K 9 
VAG23=DAG23 (K ) 

VAR23=DAR2o <K ) 

V AG33 = DA»53 IK 9 
VaR33=DaR33(K) 

V A 1 1 3 = DA 1 1 3 ( K 9 

V A I 23 = DA 1 23 ( K ) 

V A 1 33= DA I 33 ( K ) 

V9Ii3=DBU3(K) 

V B 1 23 = Db 1 23 ( K 9 
V8I33=DdIs3lK) 

VAA13=DAA13(K9 
VAA23=BAA23 (K ) 

PRINT 60 

PRINT 58u»Al3»A23»A33 

58u FORMAT { 3X IRECTIBN COSINES OF LOCAL VERTICAL ARE * F 1 2 . 6* F I 2 . 6* 
1F12.8J 

IFILP .EQ. 0) »8 16 610 
GO TO 66'J 

590 PRINT 60u j ISUN 

600 FORMAT ( iX,^ISUN=4^ 1 THE SPACECRAFT IS IN EARTH SHADOW* I HE 
llURECTION COSINES OF SUN LINE CAN NOT Be OE I ERh I SMEL>$* / 9 
IFCLP .EO . U 9 GO TO 650 
GO 10 <o30*640*86li J*LP 
610 PRINT 620 
620 FORMA! ( iril 9 

WHEN LP IS LESS THAN 3* CTJL* CT2* EAL.EdT* * ARE INPUT DATA TO 
SUBROUTINE FOR PRINTING PURPOSE. 

CT i=DALFA 
CT2=DBETA 
EAL=ALI 0 
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E8T=BTJD 

IF (LP.EQ.U) GO T 8 650 
GO TO (63U*640)*LP 

630 CALL PL0T(LP,GAMA.,lSUN,SX*SY*SZ*S2»S3*CTl,Cr2*EAL*EBT) 
GO T 0 970 

640 CALL PL0T(LP,6A.tA,ISUN,SX,SY>Sz,S2,S3*CTl,cn2jEAL,t.aT) 
GO T 0 970 

650 CALL PLOT (LP, GAMA, ISUN»SX*SY*SZ.*S2*S3*CTl»Cr2*EAL*£BT) 
I F ( I SUN „EQ. o) 00 T 6 970 
I F ( MLP .EG. 1) 60 T 0 970 
C************************’ 

C*P ART 3 DEI ERMINAl 10N »F BODY AXIS 


66C I F ( K ,E0. 3) G0 10 670 
I=K 

G0 TO 660 
670 DO 830 1=1*2 
A 13 = A A ! 3 ( 1 ) 

A23=AA23( I ) 

A33=AA33< i ) 

VAE13 = DAE13 1 I ) 

V AE23=DAE23 l I ) 

V AE33=BAE33 ( I ) 

VAGi3 = DAGio 1 I > 

VAR13=DAR13 ( I ) 
v’aG23=DA623 ( I ) 

VAR23=DAR23 ( 1 ) 

VAG33=DAG33 ( I ) 

V AR33=DAR33 ( I ) 

V A 1 13 = DAI 13 1 1 } 

VA123=DAI23 ( I ) 

V A I 33 = D A 133 ( 1 I 
V8 I 13 = DB I 13 1 I ) 

VB I 23 = DB I 23 ( I ) 

VB I 33=Dri I 33 ( I ) 

VAA13=DAAl3 < I ) 

VAA23=DAA23(I ) 

680 Q=S3 

n = Q*Q-l , d 

IF ( ABSF1D ) .LT , ( .001**2 )) GO T6 840 
A 11 = « Si * ( A13*a-sx )+S2* (SZ*A23“SY*A33) ) 71) 

A 2 1 = ( S 1 * (A23*Q-SY ) +S2* (SX*A33 _ SZ*A13) >/D 

A31=(Sl*(A33*Q-SZ)+S2*(SY*A13-Sx*A23))/D 

A 12 = ( S2* l A13+G-SX )-Si* ( SZ*A23-SY*A33 ) ) /D 

A22=IS2*( A23*3-oY)-Sl* 1SX*A33-SZ*A13) >/D 

A32=(S2*1 A33*Q-SZ)-S1*ISY*A13-SX*A23) >/U 

THi=ASINCA2o)/RAD 

TH£ = A1 AN ( -A 13* A33 ) /RAD 

IF( AbSF(A23) .GE.1.0) GO TO 7U0 

QSA23=SURTF( 1 ,U-A23*A23 ) 

PJ-iE = ASIN(-A2i/0SA23)/RAD 
GO T 0 720 
700 PRINT 710 

710 F0RMAT(3X*$YAw ANGLE CAN NOT BE DETERM 1 N£D* St f II TO 50 DEG„$,/) 
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o o 


PHE=50.0 

720 TH ( I ) =TH 1 
TE(I) =THE 
PH ( I ) =PHE 
LU=10+< 1 - 1 ) * 3 
AW ( LU ) =PH£ 

L V = 9 + ( i-1 ) *3 
Art ( LV ) = THE 
LW=S + ( l-l ) *3 
AW ( LW ) =THi 
A A 1 1 ( I > = A 1 1 
AA21 ( 1 >=A21 
AA31 ( I > = A 3 1 
AA12< I ) -A 1 2 
AA22< I )=A22 
A A32 ( I ) = A32 
AA131I )=A13 
A A23 ( I ) = A23 
A A 33 < I )=A33 

IFILE .tQ, 0) &6 10 730 
IFULE.Ed.i). OR. (LE.EQ.5) ) 00 TO 870 
1 F ( ( (LE-1 ).Eu.2) .OR. ( CLE-I ) .EU.O) ) 00 TO 730 
GO T 0 87<J 

***** 

PLOT THE ERROR ELLIPSE 8F A23*A13 

730 LP=3 

CT1--A23 
CT2 = -A 13 
EAL=3.y*VAA23 
E8 T = 3 »0*V AA13 

CALL PLOT (LP,GAMA, I SUN, $X, S Y, S £, S2 * S3, CT 1 , CT 2* t aL, EBT ) 

c * * * * * 

C*****CALCULATE 1 HE PAK1IAL DERIVATIVES OF U W * R . T # AL I 0* b 1 I Q, G AM A, E PC . 

C*****rALCULAT£ the STANDARD DEVIATION of A12#A22-A32 
IF(MLP.EQ.u)GO TO 740 

DA 12= ( S2* (-DSXA1-S1* ( A23*DSZA-A33*DSY A ) ) /D 
Drfl2 = (S2* I-DSXB ) -SI* ( A23*DSZS-A33*DSYS ) ) 7D 
DE12=l52*0*VAEl3-ol* l SZ* V AE23-S Y* VAE33 ) ) /D 
DG12= lS2*«*VAGi3“Sl* (-SZ*VAG23“SY*VAG33) ) /D 
DR 12= (S2*U*VAR13-S1* < SZ* VAR23-SY*VAR33 > )/D 
DDA12=SQRTF(DA12**2+DS12**2+DE12**2+DG12**2+UR12**2 ) 

DA32=<S2* (-DSZA)-bl* < At3«DSYA-A23*DSXA ) )/D 

f)B32= (S2* (-DSZB )-Sl* ( A13*DSYB-A23*DSXd ) ) /D 

DE32= ( S2*Q*VAE33-S1 *(SY*VAE43~SX*VAE23))/D 

DG32= (S2’«0*VAG33-P1* (SY*VAG13“SX* VAG23 ) ) / D 

DR32=(S2*0*VAR3J-Sl*lSY*VAR13“SX*VAR23J)/D 

DDA32=SQRTF (DA32**2+Ds32**2+0E32**2+DG32**2+DK32**2 1 

GO TO 7b J 

7 AM DK 1 2= S2* < 0*VA l 13-DSXA ) -Si * ( Si * VA 1 23 + A23* DSZ A-S Y * V A 1 33- A33* DS Y A ) 
DK32= S2* (0*VA133-DSZA )-Sl* (bY*VAll3+A13*USYA-SX*VAl23-A23*D$XA) 
DL 12= S2* (U*Vrfl 13-DSXB)-Sl* ( SZ* Vy I 23+ A23+DSZB-S Y* Ve 1 33- A33*Db Y B ) 
DL32= S2* ( 0* Vd 1 33-DSZB J-Sl * ( S Y * VB 1 13+ A 13*DS Y H-SX* Vti 1 23- A23* Db Y B 1 
DA12=DK12/D 
DA32=DK32/D 
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D312=DL12/D 

0332-DL32/Q 

DG12= (S2*u*VAGl3-Sl*(SZ*VAG23-SY*VAG33> ) 

DG32= C 32*Q*VaG 33-S1* {SY*VAGl3-SX*VAG23> )/D 
DR 12= CS2*G*VAR 13-Si* ( S Z* V AR23-S Y * V AR33 > ) 

DR32= C$2*G*VAG33-SI* < S Y* V AG 13“SX * V AG23 ) ) /D 
DDA 12=SGRTF< DA 12**2 + DB 12**2+DRl2**2 + Dbl2**2 ) 

DDA32=S0RTF< D Ao2* *2+UB32«-*2 + DG32**2 + DR32** 2 > 

750 DA A 1 2 C 1 )=DDA12 
DAA32 C I )=DDA32 
PRINT 6b 

PRINT 7bJ»I,AA13t I ) , I , A A23 ( I),I,AA33! I ) 

760 FORMAT <3X,$Al3<#, 1 1 » $) =#, F 1 1 . 6, 2X.&A23 (#, I 1 . # > =#, F 11 . «> 

12X,$ A33 ($, I i,$)=#,Fl J,.8,/> 

PRINT 77 J, UAAU( I ), I»AA21 ( 1 >,1, AA31 U > 

77Q FORMAT (3X,$A11 <§, U »&> =S, F 1 1 . 0- 2 X,#A2 1 ( $, 11 »# ) =$, F 1 1 . 8, 

1?X.$A31 <$,Il,#)=#,FU.8,/> 

PRINT 78J, I,AA12 ! I > , I, AA221 I )* i, AA32t I > 

760 FORMAT! 3X,$A 12 (§, 1 1 , #) = #, F 1 i . 6, 2X»$A22 !#, 1 1 * #) = #» F 1 1 . 6* 
l?X,$A32!$,Il,#)=S,r 11.8,/) 

PRINT 790* I, TH U ), I,TE (i), l,Ph ( I) 

79 0 F0RMAT(3X*^R8LL ANGLE TH ( &, 1 1 * #) =$, F 10 . 5* # DLG., PITCH ANGLE TE!$, 
1 1 1,#)~$,F1G.5,& DEG., YAM ANbLE PH (&, 1 1, $) =#, F 10. 5, $ DEG.#,/) 
PRINT 50 
PRINT 60 

PRINT 82u, I,DAA12tI),I » DAA32 ( I ) 

820 FORMAT (3X, ^STANDARD DEVIATION 0F Al2*A32 ARt, DA 12 ($» 1 1 , 
1$)=#,F8.5,$, DA32<&,H,fc>=#,F9.6,/> 

C * it * * * * 

LP = 4 

DT1=-A32 
DT2=“ A 12 
FAL=3.0*DBA32 
FST=3.0*DDA12 

CALL PLOT (LP, GAM A, I SUN, SX, S Y, SZ* S2, S3 » UT 1, DT2* F AL, FBT ) 

830 CONTINUE 
GO TO 97 U 
C****** - *** 

840 PRINT 850 

850 FORMAT! IX, ^SUNLINE AND LOCAL VERTICAL ARE IN THE SAME LINE, NO 
1 FURTHER CALCULATION FOR A12,A22, A32,ETC.$, / ) 

I F ! LE. NE . 0 > GO TO 870 
I F ( K .EQ. 3) GO TO 940 
K A 1 = K 
KA2=K 
GO TO 950 

860 PRINT 30U, AA13 l 1 ) » AA23 ( 1 ) » AA33 ( 1 > 

PRINT 310, A A 13 <2 >,AA23 (2) ,AA33 (2 » 

PRINT 380, THli),TE!l) 

PRINT 390,TH(2),TE(2> 

PRINT 60 
AW ( 8 ) =TH < 1) 

A W < 9 ) =TE 1 1 > 

Aw ( 1 1 ) =TH ( 2 ) 
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AW< 12 l=T£(2) 

IFILE.EU. 0) GO re 940 
870 GO 10 (880*900* 920 » 920 » 920 ) * L t 

880 PRINT 890 

890 FORMA T(3X,&DEVI AUON OF 023 I 9 TOO LARGE* HENOc. THERE IS NO ERROR 
tC ALCULAT I ON FOR A 1 3* A23* A 33&* / ) 

CO T 8 970 


900 PRINT 9io 

910 FORMA T ( 3X*$|DAG) 3 ( 1 ) * DAG23 ( 1 > CAN N01 BE DETERMINED. NO FURTHER 
1 C ALCUL AT ION FOR ERROR ELLIPSt ft*/) 

GO TO 970 
920 PRINT 930 

93U FORMAT (3X*&DAG23( I ) * 0 A G23 ( 2 ) CAN NO f BE DETERMINED. NO FURTHER 
tC ALCULAT 1 ON FOR ERROR ELLIPSE ft*/) 

GO TO 970 

940 PRINT 46U*DAA13 ( 1 >*DAA13 (2) 

PRINT 490* DAA23( 1 )*DAA23I2) 

PRINT 60 
KA1 = 1 


KA2=2 

950 DO 960 I = K A 1 * K A2 
0 T 1 = - AA23 ( I ) 
CT2=-AA13t I ) 


EAL=3.U*DAA23( I ) 

F8T-3.0*DAA13( I ) 

CALL PLO T ( LP* GAMA* I SUN* SX* S Y* 82* S2* S3* C T 1* CT2* t AL, E bT ) 
960 CONTINUE 


c * ★ ★ * * 1 
C*P ART 4 . 


f **********1 


.SUMMARY of runs 


r*********** 


970 MRUN=MRUN+1 

WRITE OUTPUT TAPE 2* 980* I A W ( I ) * I = 1 * 13 ) 
980 FORMAT ( lX* I 3* 13 I 1 X* F8 . 2 ) * / > 

I0R=IO 


GO TO 20 

990 P0 1U0G J = l* MRUN 
1000 BACKSPACE 2 

PRINT 1010'IOR 

1010 F0RMaT(4jX*$ SUMMARY OF RUNS FOR ORBIT NO . $* F 8 . 2*2X* $ $) 

PRINT 60 
PRINT 1020 

1020 F0RMAT{2X*ftNO.ft,3X*ft0ATE#,7X*g|-|R.g,5X,ftMIN§*7X*$SEC$* 
14X,$0RBITft*5X.^GAMA^*4X*gReMC$.7X*ftTHlft*5X*$THETA$* 
25X* ; *PHI J, *5X*'THI',5X* J THE T A' * 6X* ' PH 1 ' ./ ) 

DO 1030 JI=1* MRUN 

READ INPUT TAPE 2* 980* C A W < I ) * I = 1* 1 3 ) 

PRINT 980* JI* UW( I )* 1 = 1*13) 

1030 CONTINUE 
PRINT 60 


M RUN =0 
ior=io 


PRINT 620 

IF(IO.NE.O) GO TO 40 
END 
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SUBROUT I NE PLOT (LP* GA* ISUN* SX* SY* SZ* &2- S3* GTi * CT2, t AL* EfcT ) 
COMMON C23* I A <90*55 ), IB(90*55> *ROMD* I DAY, ITIM 


C 

c this program is using p&lar coordinates for plot 

C AE AND BE ARE THE MAJOR AND MINOR AXIS OF ELLIPSE 

C IA REPRESENTS THE PLOT FOR A13 AND A23. 

C 18 REPRESENTS THE PLOT FOR A12 AND A32. 

C WHEN LP=Q^ CC=C23*WHERE C23 IS CALCULATE FROM MAIN PROGRAM 

C WHEN LP = i* C23 IS LESS THAN -0.3733(PUT CC=-0*3733 

C WHEN LP=2* C23 IS GREATER THAN 0.9277IPUT CC=0.9277) 

C 

SNG=SIN( GA> 

CNG=COS(GA) 

GaD=GA/i>. 01745329 
CC=C23 

RC=1.0-CC*CC 

CCN=CC+CNG 

SRC=SGRTF(RC) 

AE=SRC*SNG 

BE=SRC 

CE=-CCN 

JXC=<CC+1]*42+1.5 
I YM=SRC*25+26.5 
DO 10 1=1*90 
DO 1 Cl J=l*55 
I At I* J > = 1H 
I B ( 1* J)=lh 
10 CONTINUE 
C PLOT Y AXIS 

DO 20 J -1 » 53 
I A ( 43* J ) =1H* 

13 (43* J )=1H* 

?0 CONTINUE 

C PLOT X-AXIS 

DO 30 J=l*87*2 
I A ( J»26)=lH* 

I 8 ( J* 26 ) =1 P* 

30 CONTINUE 

C LABEL FOR A23 AXIS 

I A ( 90* 26 ) =1 HA 
I A ( 89* 20 ) = 1 H2 
I A (88,26 >=1H3 
IA ( 87* 26 ) = 1H+ 

C LABEL FOR A32 AXIS 

18 ( 90* 26 ) =1 HA 
18(89* 26 ) =1 H3 
I B ( 88* 26 ) = 1 H2 
18(87* 26 ) -J.H + 

DO 40 J=1*S5*21 
I A ( J*26)=lHI 
I S ( J*26)=1H1 
40 CONTINUE 
****** 

LABEL FOR THE CENTER 3 OF CELESTIAL SPHERE 
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I A < 43*26 ) = 1H6 
1 8 I 43*26 ) = iHQ 

C AL REPRESENTS P3LAR ANGLE 

AL = 0 

RP=1 .0 

CALL POINT (AL*RP*X1* Yl, 1X1*1 Yl ) 

C DAL IS THE INCREMENT 0F ANGLE FOR POLAR COORDINATES METHOD 

DAL=5.U*U. 01745329 
IFILP.Ll .3 )G8 T9 100 

c * * * * * ★ 

C PlQT ERROR ELLIPSE WHEN LP IS GREATER THAN 3 

SNU = C!.0 

csu=1.0 

50 CALL ELIPS(SNU,CSu*AL*EAL*E8T*CTl*cr2*XER,YER*lXR,IYK) 

I A ( 1 X 1 * 1 Y 1 ) =1H* 

18 ( 1 X 1* 1 Yl ) = 1H* 

IF(AtSFIXER) .6 r.i.GIGS To 60 
Y£M=SQR TF( 1 ,Q-X£R*X£R ) 

I F t YER.GT.YEHIGO TO 60 

I F ( ( 1XR.LT.0- 0R.IXR„GT.65>.0R.< IYR.LT.O. OR . I YR . 6T . 52 ) > GO T9 60 
I A < IXR, I YR ) =1HR 
IB< I XR* I YR ) = 1HR 
60 AL=AL+DAL 

CALL P8INT(AL*KPj.X1*Y1* 1X1* IY1 ) 

IFtAL.LE.o.3) GO TO 50 
CT 1 = -CT 1 
CT2=-CT 2 

IXER=(CT1+1)*42+1.5 
I YER=CT 2*25+26. 5 
I A < I XER* IYER ) = 1HR 
I B t I XER* IYER ) = 1 Hr 
PRINT 510 

IFtLP.EU. 4 ) GO re 80 
PRINT 70*Cfl,CI 2*EAL*EBT 

7u FORMAT ( 1X*$ERR0R ELLIPSE 8F A23 *a 13: CENTER AT A23=g* F 8 . 5,g* A13 

1=-$*F6.,5*$» AXIS PARALLEL TO A23=S*F8 .5*g* AXIS PARALLEL TO A13=3* 
2F8.5) 

G9 T9 6b J 

80 PRINT 9 U*CTl*Cl 2 *EAL*Eer 

90 F3RM*T( lX*$ERRoR ELLIPSE 9F A32*A12* CENTER AT A32=$» F 8. 5*$, A12 

i = $*F8.5*$* axis parallel tq a32=S*f8.5*S* axis parallel to ai2=&* 
2F8. 5 ) 

GO TO 530 

c ***** * 

100 PRINT \ lu 

lto FORMAT! 2UX*$,SUN SEmSOR INFORMATION if* 25X»$E AKTH SENS9R 1NFORMAIION$ 

t - / ) 

I SUN=0 MEANS NO INFORMATION OF SUN LINE DIRECTION 
ISUN=1,2.3* MEANS INFORMATION OF SUN L InE is AVAILABLE 
I F ( ISUN.EU.O) GO T9 360 
C INFORMATION FROM SUN SENSOR A V A I L AtsL . PLO T THE REGION 

I XA= ! S3+1 1*42 + 1.5 
I X8= ( S2 + 1 1 * 4 2 + i .5 
SR-SURTF ( abSF 1 1 .0-S2 + S2) > 
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ST = SGRTFUBSF{ 1.0-S3*S3 ) > 

C AP AND dP ARE THE MAJOR AND MINOR AXIS OF ELLIPSE IN A 1 3* A23* PLOT. 

AP=AbSF(S£*ST ) 

8P = ST 

C AQ AND SO ARE ThlE MAJOR AND MINOR AXIS OF ELLIPSE IN A12,A32 PLO I . 

AQ=A8SF(SY*SR) 

BQ = SR 

C (EX,EY) » (FX,FY) ARE CENTER OF EACH ELLIPSE. 

EX=~S3*SY 
EY^-SS^SX 
FX=-SZ*S2 
F Y=-SX*S2 

RXY=SQRTFCSX*SX+SY*SY ) 

RXZ=SGRTF(SX*SX+SZ*SZ ) 

C ***** * 

1 F ( SX .EG. O.Q> 00 TO 12U 

SM--S Y /S X 

SN=-SZ/SX 

SK-S3/SX 

SL-S2 /SX 

120 CALL TEST (oX,SY,SZ, IS ) 

CALL TEST<SX,SZ .SY,LS ) 

IFILS • NE . 1) GO TO 130 

SNF=SX/RXZ 

CSF=SZ/RXZ 

FL=AS INI SinF ) 

130 GO TO <160*160* 14u*150)*IS 
Q ***** * 

140 I Y = I Y 1 
I X = I X A 
X3-S3 
Y3 = Y1 
GO TO 190 

c ***** * 

1 =5G Y3 = SM*X1+SK 

IY =Y3*25+26.5 
i X = I X 1 
X3 = X 1 
GO TO 1 9y 
£****** 

160 SNE=SX/RXY 
CSE=SY/KXY 
EL = AS I N t SNl ) 

170 ANGLE=AL+EL 

CALL EL I PS ( SN£, CSF, ANGLE, AP, BP, EX, E Y, X3* Y 3, I X, 1 Y ) 

GO TO 19U 

0 * * * * * 

C CALCULATE THE COORDINATES OF CIRCLE 

1 sc CALL POINT <AL,ST,X3,Y3, IX, IY ) 

190 IF ( ( IX .LT . J. OR. IX.GT.85> .OR. ( 1 Y .LT .U- 0R.1Y.GT.52)) GO TO 250 
I A ( IX, 1Y) = 1H = 

GO TO (200-200* 230*230 )* IS 
200 A3=(S3-X3*SY-Y3*SX )/SZ 
PRINT 210*X3*Y3,A3 
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210 FORMAT ( iX,$A23 = #.,F9.6.. 10X , #A 1 3=$, F9 . 6» 1 oX,§A33=S,F9. 6 ) 

I F ( A3 .LI, Q.j) bo T 6 223 
IA ( IX, I Y I =1 HP 
GO T 0 250 
220 IA( IX, I Y ) = 1 HiN 
GO T S 25j 

23 0 PRIM 24o*X3,Y3 

240 FORMAT! llX,$A23=#,F9. 6, fa a,$ A 13=#* F 9 . 6, 8X*$S1GN BF A33 UNKNOWN#) 
250 GO TO ( 260* 270 * 200* 290 ) * bS 
C*****CAl-CULA Te A12,A32 REblCN bY SUN SENSOR INFORMATION 
260 mNGLF=AL+FL 

CALL EL I PS ( SNF , CSF, ANbLF, AQ, BU, FX, F Y , X2, Y 2, I X, 1 Y ) 

GO TO 3 GO 

27v CALL POINT (AL*SK*X2*Y2*IX,IY) 

GO 10 30b 
23o I X = I XB 
I Y= I Y 1 
Y2 = Y1 
X2=S2 
GO TB 30U 
2 Qj Y2=SN*X1+SL 

I Y = Y2*25 + 26 .5 
X2-X 1 
IX=IXi 

30u IF ( ( lX.LT.-j. OR. IX. 51,85) .OR. tlX.LT.O. OR . I Y . GT . 52 I > b& IB 360 
Id ( IX, IY)=m = 

C ***** * 

GO TO (3 to, 3iO»34u,34u ),Lfa 
3 ! 0 A2= < S2-X2*bZ-Y2*SX ) /SY 
PRINT 32U*X2,Y2,A2 

320 FORMAT ( iX,$A32=#,F9. 6, 8 X, #A 1 2 = #, F9 . 6, 8X, $A22=$* F 9 . 6, / ) 

I F ( A2 .LI . J.u) bO 10 330 
I B < IX, I Y > = IriP 
GO T 8 36b 
330 I B ( IX, I Y > = 1HN 
GO TO 360 

340 PRINT 35G,X2,Y2 

350 FORMAT < 1 X, &A32=* $, F9 . 6* 1 uX,$A 12=#, F 9 . 6* 9X,$S I bN BF A22 UNKNOWN#) 
***** 

INFORMATION FROM cARTH SENSOR BNlY 
360 1 F ( GA .NE. 0.0' Go TO 370 ' 

NS=i 

G8 TO 380 
370 NS = 2 

PLOT THE UeLESTIAl SPHERE. 

33b I A ( IXi . I Y1 )=1H* 

Ib(IX1,IY1 )=1H* 

GOTO ( 390*410 ), NS 

IF GAMA IS EERO, I HE REGION IS A STRAIGHT LINE, A23=CC 
PLBT THIS LINE 
390 IX=IXC 

I F < I Y1.G1 . IYM)bO TB 470 

I Y= I V 1 

x=cc 
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Y = Y 1 

PRINT <iuO^»Y 

4Qu F9RMAT(5-jX»^A23=Jt,F9.b» 8X,gA 1 3=#> F 9 . b »6X, $S 1 Gn OF A33 UNKNOWN#) 

G0 T9 43'J 

C * * * * * 

IF IT IS ANOTHER ELLIPSE (BY EARTH SENSQR INFORMATION) 

CALCULATE THE C99RD I NATES 8F THIS tLLlPSE 
4 10 CALL ELlPS(0«0<l«0*AL»AE«B£«Cli»0*0iX*Y#l](«lY) 

AZ3= (CC-X*CNG)/SNG 
PRINT 420, X,Y,aZ3 

d?j FORMAT (65X,^A23= : $jF9.6» 8X , $A 13=$» F 9 . 6 , 6X ,$A 33=8. F 9 . 6 ) 

43'J IFUIX.LI.j. 9R.1X.&1. 85 ).ttK.(IY*LT»CJ. OR . I Y . bT .52 n GO TO 470 
I A ( IX, I Y) = lHi 
IF (GA.EU.O.O) GO T9 47U 
IF(LP.EW.O) G6 TO 45U 
IF(A23 .‘G£.w> GO To 440 
G B TS d 7 J 
44u I A ( I X, I Y 3 = iH. 

G9 TO d7j 

45u I F t AZ3.GT.UJG8 TO 46u 
I A ( I X, I Y ) = 1H- 
G6 TO 4 70 
4A'J IA( IX, I Y)=1H+ 

C * * * * *.* 

470 AL = AL + |'JAL 
RP-1 

CALL POIinT IAl,RP»X1, Y1.1X1. 1 Y1 > 

IFCAL.Gl .6.3) G9 TO 480 
I F ( I SUN .cU .0 ) bO T9 380 
GO TO ( 170-18O14J, 150>*IS 
4 AO IFC IS0N.hu. U) GO 79 570 
I F t I S.Nc . 1 ) bo TO 49u 
I X=< -EX+1 ) *42+1.5 
I Y=-EY*25+26.5 
I AC IX, I Y) = 1HE 
490 IFCLS.NE.U G9 T 0 500 
I X= ( -FX+J ) *42+1.5 
I Y=-FY*2b+26.5 
IBCIX,IY)= 1HF 
500 PRINT 5Iu 
550 F8RMAT ( 3 Hi ) 

PRINT 52u, iSUN.C Ii,C J2,EAL,E& 1 

5?u FORMAT ( 1X,$ISUN= I 2 , $», ALFA = #, F 8 » # BE b , Bel A = $>, F fc) • 3 , # ae G , A Z “ $ 
l,F8.3,$UEt, C.L = $,F8.3,$ UEG. P F0R+A22 ( 0R+A33 > , N F9K-A22 l 0K~ A33 ) $ ) 
530 09 550 J = i-*52 

PRINT 54<J, ClBCI.J), 1=90,1, -1) 

5 40 F8RMATC2JX,IOOAU 
550 CONTINUE 

PRINT 560, 1 DAY, II I M 

560 F9RMAT { d4X,^A 12 + #, 3 5 X , I 4 , ^ , I 6 , / ) 

i F ( LP .bE. 3) GO TO 69U 
G6 TO 59 o 
570 PRINT 51u 
PRINT 580 
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58u FORMAT ( IX»$NO SUN SENSOR I NFSRMATueN, NO PLO I F8R Ai2,A32$J 
590 PRINT 5 1 J 

IF ( LP . b T . (j I uO FO 610 
PRINT 6uu»GAD, CC,K6MD 

60 J FORMAT! 1 X, ftG AM A = $, Fe> .2, $ DEG. C23=$*F7.4,$ ROM=$, F 7 . 3* $ DEG, IF 
J GAMA NOT 0* + FOR +AJ3,“ FOR -A33J IF GaMA = CI, 1 FOR &3lH$! 

G 9 TO 6 60 

olO G9 TO (o20-»o40) .LP 
67u PRIM 63.j,bAU,CC 

630 FORMAT ( 1X,$GaMA=$,Fc>. 2, $ ucG, KOM=u* C23<$»F o.3,&, . I'S FOR + A3'3 

JI FOR - A33 IF irArtA NOT U » Wl-tiV GAHA=0. 1 io FOR EITHER^) 

GO TO 6 6 u 

040 PRINT 650, GAD, CC 

650 FORMATt lX,fGAnA=^,F6.2,4 DEG, R0M=180 D£b,C23>S,F6-3>$, . For +A33 
II FOR -A33 IF GAMA NOT ‘Ji WHEN &AMA=U, I FOR clTHtR^) 

660 DO 670 J=l,52 

PRINT 540, UA l I, J) , I=9u,l,-1 ) 

670 CONTINUE 

PRINT 680,IDAY,ITIM 

680 F0KMAT(64X,$A13 + #,35X,I4,$, $,l6,/) 

690 RETURN 
END 

SUBROUTINE TEST (TX,TY,TZ,JS) 

c 

C CONDITION FOR ElLIPSe, CIRClE* OR STRAIGHT LINE IN PLOT 

C (1) hihEN JS =1. IT IS AN cLLIPSE 

C (2) WHEN JS = 2 » IT IS A CIRCLE 

C (3) WrttN J S =3, IT IS A S Tk A i bH f LINE PARALLEL To Y AXIS 

C (4) WHEN Jb=t, IT IS A 3TKA1GHI LINE wjlh SlOPE - TY/fX. 

C 

A 1 Z = ABS t TZ ) 

IF (a TZ.Nl.'J.J) GO TO 20 
F F ( TX .Nt . J. U ) bO TO 10 
JS = 3 

GO TO 40 
la J S = 4 

GO TO 40 

?C IF (ATZ.SU. 1) GO TO 30 
JS = 1 

GO 10 4u 
3C JS = 2 
4o RE TURN 
FND 

SUBROUTINE EL IPS CsNU,CSU, ANG l, A,ti,CX,CY, XL, Ye- IX, I Y ) 

CALCULATE TmE COORDINATE;? OF ELLIPSE. 

A AND 8 ARE THE HALF EENGfn OF MAJOR ANu MINOR AXIS 
A>IGL REPRESENTS CURRENT POlah ANGLE 
<CX,CY) RtPREoENTS THE CENTER OF ELLIPSE 

c ( xe, y t ) are curreni point represented as {ix,iy) for plot 

c 

S A N = S I N ( A in G L ) 

CAN-C8S l ANG'L ) 

XEX=A*CAN 
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YEY = B*SA!'J 

XP=XEX*CSU- YEY*SNU 
YP=XEX*SNU+YEY*CSU 
X£=XP-CX 
YE=YP-CY 

IX=<XE+1 )*42+l.o 
I Y=YE*25+26.5 
RETURN 
FND 

SU8R9UT I Mb Po i N f ( AL, RP, X, Y , 1 X, l Y ) 

C 

C AL REPRESENTS POLAR ANGLE 

C ( X » Y ) REPRESENIS lURREnI POINT OF A CIRCLt. 

C RS REPRESENTS RAUIUS 

C 

SNL=SIN( Ai_ ) 

CSL=C0SIAL> 

X=KP*CSL 
Y=RP*SNL 
I X= ( X+ 1 ) *42+1.? 

I Y= Y*25+2fe • 5 

RETURN 

END 
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APPENDIX G SAMPLE OF OUTPUT 



EARTH SENSOR INFORMATION GIVES? ' ; 

6 AM A ( IN pE6REE)a-23. 570000. ETUN DEGREE ) * -5.050000, ROM (IN DEGREE >« 56.000000 






iimi 


'R INFORMATION 

GIVES : 


LQ B£G^___ELE 

y moN° ~zs.t± 

/ 

Q.QOQ. ... -DEG.. 


Slim »_62A5JLL, S J? I ° - . 5 _2_ 1_6_R_6_, S 3J_«_ 58I 33R. A l F A ( I N 

— Ld,L-,PJ * J.&HP &^JLUiE.S.-SLf. „Si>r^.LJ. N,E _ jv a_R., T_._ S_PA.CXe. PAF J A 

-_XHE__fi.UiEXJ.LO N . CO.SAN ELS „ 0 S ILN LINE J» .it . T_* l.QJE Q C E N L fiJLC AXJ_S_ 



&XV LA Xi ON — LN — A. 1 X.. D.A! 1UU-3 ..ALTA 8 , WU.1A2JL? .AULAS 

DEVIATION in A 2 3 , DA23ll)o .01506 , DA23I2>*» .01589 

DEVIATION IN A 3 3 , DA33I1>» .00729, 0 A33(2>a .00632 


DIRECTION COSINES OF LOCAL VERTICAL are: ,08797899 m68M*(860 .92597572 
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All ( 2 ) ■ ♦9869&56A A2 1( 2)a -.O^ASHiS A31(2)=» -♦1 20727^9 

AJ_2J_2_Lr» ^750^163 &JJ&L* •..9.2A3 A«HP.9 A 3 21 2. U. » ..3 A7 7 3.9, R | 

ROLL ANCLE TH ( 2 ) « 21.61997 DEG. .PITCH ANGLE TE(2)» "5^30*12 PEG*. YAW ANGLE PH(2(<= 3**18524 DEG o 

M4OMDO0** 


«»»•»♦♦»♦«» 

STAND A RD PE V 1 AT I ON OF A12.A32 ARE . P A 1 2 ( 2 ) » .0191&. PA32<2 )« .015313 
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A 32+ *e*»»«*99o a[o « « * a 9 


RUHR 

KR«Ro • I < 



i B3 


A 1 2* 


257, 2351H0 








*********** 


SUMMARY OF RUNS FOR 0R8IT NO. 550.00 . „ -. 


NO. 

DATE 

HR. 

MIN 

SEC 

ORB 1 T 

GAMA 

R0MD 

THI 

theta 

PHI 

THI 

theta 

PHI 

1 

257.00 

23.00 

49. QO 

10.00 

556.00 

“22.62 

54,40 

.00 

.00 

.00 

-25.96 

-176.34 

-2.-3/' 

2 

257.00 

23.00 

51.00 

40.00 

556.00 

-23.57 

56.00 

.00 

.00 

.00 

21.62 

-5.43 

2.4/ 

3 

257.00 

23.00 

54. QO 

6.00 

556.00’ 

-22.82 

57.60 

.00 

.00 

.00 

22.11 

-7.22 

3.32 

4 

257.00 

23.00 

56.00 

17 .uO 

556.00 

-20.59 

56.00 

-22.29 

174.54 

.00 

18.73 

-5.33 

.00 

5 

257.00 

23-00 

56.00 

12. UO 

556.00 

-18.36 

57.60 

-18.72 

175.53 

.00 

17.90 

-4.45 

.00 
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